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DESCRIPTION 

CONTROL DEVICE FOR MOBILE BODY 

5 Technical Field 

The present invention relates to the control of a 
floor reaction force of a mobile body, such as a legged 
mobile robot and a wheeled mobile body having an active 
suspension. More specifically, the present invention 

10 relates to a device that is resistant to the influences of 

an unknown slope, projection or depression of a floor 
(ground surface) with which a mobile body, such as the 
legged mobile robot or the wheeled mobile robot having an 
active suspension, comes in contact, and that properly 

15 controls floor reaction forces. Moreover, the present 

invention relates to a device adapted to properly control 
a floor reaction force while estimating the configuration 
of a floor. 

20 Background Art 

Japanese Unexamined Patent Application Publication 
No. H5-305585 by the present applicant (Patent Document 1) 
discloses a technology of the compliance control of both 
legs of a two-legged mobile robot. This technology is 

25 applicable also to a robot having, for example, four legs. 

In this case, according to the compliance control based on 
the technology disclosed in the publication, a virtual 
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plane is inclined while all legs are in contact with the 
virtual plane, so that an undulation or tilt over a large 
area of the floor can be coped with. According to the 
technology of the publication, however, there have been 
5 cases where a load (floor reaction force) is not properly 
distributed if a floor has a local tilt, projection or 
depression. As a result, poor contact with a surface has 
sometimes occurred, causing a portion (foot) to be in 
contact therewith to shake or to be subjected to an undue 

10 landing impact, with consequent deteriorated properties of 

foot contact with the ground. This has further led to a 
danger in that a robot easily slips or spins. Further, 
there have been cases where control fails to properly 
distribute a floor reaction force moment for restoring the 

15 posture of the robot to a desired posture to the distal 
portion of each leg, causing the posture of the robot to 
shake. There have been also cases where, if a certain 
portion of the robot starts vibrating, then it is 
inconveniently difficult to attenuate the vibration. 

20 Further, there have been cases where the failure of proper 
control of distribution of a floor reaction force to the 
distal end of each leg results in excessive load on some 
actuators . 

In addition, Japanese Unexamined Patent Application 
25 Publication No. H10-277969 (Patent Document 2) and 

Japanese Unexamined Patent Application Publication No. 
2001-322076 (Patent Document 3) by the present applicant 
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disclose a technology for composite-compliance control and 
a technology for estimating the configuration of a floor. 
These technologies make it possible to properly distribute 
a floor reaction force to the distal portion of each leg 
5 in a two-legged mobile robot and to compositively estimate 

the configuration of a floor, more specifically, 
compositively and accurately estimate the inclination of 
the ground contact surface of each leg distal portion and 
the height difference between ground contact surfaces at 

10 the same time. These technologies in the publications are, 

in principle, applicable to a multi-legged robot, such as 
a four-legged robot; however, no description has been 
given of a technology for specifically applying them. 
Further, there has been known a technique for 

15 estimating the height of a floor at the time of landing by 
using feelers (load sensors or contact sensors) provided 
at the distal ends of the legs of the four-legged robot. 
However, this technique is a sequential technique and has 
been incapable of dealing with a case where a floor 

20 deforms after landing, as with a soft ground. Especially 
when the main body of the robot is severely vibrating, 
such as when the robot is moving fast, the height of a 
floor cannot be correctly estimated, and there has been a 
danger in that load is not properly distributed to each 

25 leg. 

There has been also known a technology whereby the 
compliance control of each leg of a robot is independently 



conducted for each leg. This technology, however, does 
not take into account the fact that the legs interfere 
with each other through the vibration of the body of the 
robot. In other words, the compliance control is 
individually carried out on each leg. For this reason, 
the compliance control of each leg does not act in harmony, 
making it impossible to properly distribute a floor 
reaction force to each leg. 

The present invention has been made with a view of 
the background described above, and it is an object 
thereof to provide a device that is resistant to the 
influences of an unknown slope, projection or depression 
of a floor with which a mobile body, such as a legged 
mobile robot or a wheeled mobile body having an active 
suspension, comes in contact, and that properly controls a 
floor reaction force. Moreover, an object of the present 
invention is to provide a device capable of properly 
controlling a floor reaction force while accurately 
estimating the configuration of a floor. 

Disclosure of Invention 

According to a first invention of a control device 
for a mobile body of the present invention, a control 
device for a mobile body that comprises a desired gait 
determining means for determining a desired gait composed 
of a desired motion and a desired floor reaction force of 
a mobile body, such as a mobile robot having three or more 
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ground contact portions connected through the intermediary 
of a plurality of joints such that mutual relative heights 
thereof can be manipulated, and a floor reaction force 
detecting means for detecting or estimating an actual 
5 floor reaction force acting on each of the ground contact 

portions, and controls the operation of the mobile body to 
make a gait of the mobile body follow a desired gait, 

wherein the ground contact portions are classified 
into a tree structure such that each of the ground contact 

10 portions becomes a leaf node, and an intermediate node 
exists between the leaf node and a root node having all 
the leaf nodes as descendant nodes, and 

relative to a B-th node, which is each node in the 
tree structure, if the B-th node is the leaf node, then a 

15 floor reaction force acting on a ground contact portion 
that is the leaf node is defined as the node floor 
reaction force of the B-th node, and if the B-th node has 
child nodes, then the resultant force of the node floor 
reaction forces of all child nodes of the B-th node is 

20 defined as the node floor reaction force of the B-th node, 
a control device for a mobile body, comprises: 
a means for determining an actual node floor 
reaction force as the actual value of a node floor 
reaction force of each node from the detected or estimated 

25 actual floor reaction force of each ground contact 
portion; 

a means for determining a desired node floor 
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reaction force as the desired value of a node floor 
reaction force of each node on the basis of at least a 
desired floor reaction force of the desired gait; and 

a node operation controlling means for determining, 
5 on each of C-th nodes, which is a node having a plurality 
of ground contact portions as descendant nodes, the 
correction amounts of the desired relative heights of a 
plurality of ground contact portions belonging to the C-th 
node on the basis of at least the relative relationship 

10 among the actual node floor reaction forces of the child 

nodes of the C-th node and the relative relationship among 
the desired node floor reaction forces of the child nodes 
of the C-th node, determines a corrected desired motion by 
adding at least a first correction of the desired relative 

15 heights of the plurality of ground contact portions 

belonging to each C-th node to a desired motion of the 
desired gait on the basis of a correction amount obtained 
by combining the determined correction amount of every C- 
th node, and operates the joints such that the corrected 

20 desired motion that has been determined is satisfied. 

In the present invention, regarding each node having 
child nodes, "ground contact portions belonging to the 
node" means, more accurately, "belonging as descendant 
nodes to the node." This applies not only to the first 

25 invention but also applies to any one of the inventions of 
the present application. 

According to the first invention, three or more 
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ground contact portions provided in a mobile body are 
classified into a tree structure, and the correction 
amounts (in other words, manipulated variables) of the 
desired relative heights of a plurality of ground contact 
5 portions belonging to the C-th node are determined for 

each C-th node such that the relative relationship among 
the actual node floor reaction forces of each node of the 
C-th node approximates the relative relationship among the 
desired node floor reaction forces of the child nodes of 

10 the C-th node. Then, based on a correction amount 

obtained by combining those correction amounts of all the 
C-th nodes, a corrected desired motion is determined by 
adding a first correction of the desired relative heights 
of the plurality of ground contact portions belonging to 

15 each C-th node to the desired motion of the desired gait. 

Then, the joints of the mobile body are operated such that 
the determined corrected desired motion is satisfied. 
This makes it possible to adjust the relative heights of 
the ground contact portions such that the relative 

20 relationship among the actual node floor reaction forces 
of the child nodes of the C-th node approximates the 
relative relationship among the desired node floor 
reaction forces of the child nodes of the C-th node while 
accomplishing mutual balance of the floor reaction forces 

25 of the plurality of ground contact portions, as compared 

with a case where the heights of individual ground contact 
portions are independently (separately) manipulated. As a 



- 8 - 



result, even if a floor with which a mobile body is to be 
in contact has a locally unknown tilt, projection or 
depression, an influence thereof will be minimized, 
permitting enhanced stability of a posture of a robot to 
5 be achieved. 

According to a second invention of a control device 
for a mobile body of the present invention, a control 
device for a mobile body that comprises a desired gait 
determining means for determining a desired gait composed 

10 of a desired motion and a desired floor reaction force of 

a mobile body, such as a mobile robot having three or more 
ground contact portions connected through the intermediary 
of a plurality of joints such that mutual relative heights 
thereof can be manipulated, and a floor reaction force 

15 detecting means for detecting or estimating an actual 

floor reaction force acting on each of the ground contact 
portions, and controls the operation of the mobile body to 
make a gait of the mobile body follow a desired gait, 

wherein the ground contact portions are classified 

20 into a tree structure such that each of the ground contact 
portions becomes a leaf node, and an intermediate node 
exists between the leaf node and a root node having all 
the leaf nodes as descendant nodes, and 

relative to each of B-th nodes, which is each node 

25 in the tree structure, if the B-th node is the leaf node, 
then a floor reaction force acting on a ground contact 
portion that is the leaf node is defined as the node floor 
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reaction force of the B-th node, and if an A-th node has 
child nodes, then the resultant force of the node floor 
reaction forces of all child nodes of the B-th node is 
defined as the node floor reaction force of the B-th node, 
5 the control device for a mobile body comprises: 

relative to a predetermined C-th node that is an 
intermediate node having a plurality of ground contact 
portions as descendant nodes, 

a means for determining an actual node floor 

10 reaction force as the actual value of a node floor 

reaction force of each child node of at least the C-th 
node from the detected or estimated actual floor reaction 
force of each ground contact portion; 

a means for determining a desired node floor 

15 reaction force as the desired value of a node floor 

reaction force of each child node of at least the C-th 
node on the basis of at least a desired floor reaction 
force of the desired gait; and 

a node operation controlling means that determines a 

20 corrected desired motion by adding at least a first 
correction of the desired relative heights of the 
plurality of ground contact portions belonging to the C-th 
node to the desired motion of the desired gait on the 
basis of at least a relative relationship among the actual 

25 node floor reaction forces of the child nodes of the C-th 
node and a relative relationship among the desired node 
floor reaction forces of the child nodes of the C-th node 



such that the relative relationship among the actual node 
floor reaction forces of the child nodes of the C-th node 
approximates the relative relationship among the desired 
node floor reaction forces of the child nodes of the C-th 
node, and operates the joints such that the corrected 
desired motion that has been determined is satisfied. 

According to the second invention, three or more 
ground contact portions provided in a mobile body are 
classified into a tree structure, and a corrected desired 
motion is determined by adding at least a first correction 
of the desired relative heights of a plurality of ground 
contact portions belonging to a C-th node, which is an 
intermediate node, to the desired motion of the desired 
gait on the basis of the relative relationship among the 
actual node floor reaction forces of the nodes of a 
predetermined C-th node and the relative relationship 
among the desired node floor reaction forces of the child 
nodes of the C-th node (e.g., such that the relative 
relationships approximate). Then, the joints of the 
mobile body are operated so that the determined corrected 
desired motion is satisfied. This makes it possible to 
adjust the relative heights of the ground contact portions 
such that the relative relationship among the actual node 
floor reaction forces of the child nodes of the C-th node 
approximates the relative relationship among the desired 
node floor reaction forces of the child nodes of the C-th 
node while accomplishing mutual balance of the floor 
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reaction forces of the plurality of ground contact 
portions belonging to the C-th node, as compared with a 
case where the heights of individual ground contact 
portions are independently (separately) manipulated. As a 
5 result, even if a floor with which a mobile body is to be 
in contact has a locally unknown tilt, projection or 
depression, an influence thereof will be minimized, 
permitting enhanced stability of a posture of a robot to 
be achieved. 

10 In the first invention described above, preferably, 

when a weight has been set on each node in the tree 
structure, and regarding a B-th node, which is each node 
in the tree structure, if the B-th node is the leaf node, 
then the height of a ground contact portion that is the 

15 leaf node is defined as the height of the B-th node, and 
if the B-th node has child nodes, then a weighted mean 
value, which uses the weight, of the heights of all child 
nodes of the B-th node is defined as the height of the B- 
th node, 

20 if the node operation controlling means determines 

the corrected desired motion for only one arbitrary node 
among the C-th nodes by adding a first correction of the 
desired relative heights of a plurality of ground contact 
portions belonging to that one node to a desired motion of 

25 the desired gait, then a desired height of that one node 

in the corrected desired motion is maintained at a desired 
height in the desired motion (a third invention) . 
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Similarly, in the second invention, preferably, a 
weight has been set on each node in the tree structure, 
and relative to the B-th node, which is each node in the 
tree structure, if the B-th node is a leaf node, then the 
5 height of a ground contact portion that is the leaf node 

is defined as the height of the B-th node, and if the B-th 
node has child nodes, then the weighted mean value, which 
uses the above weight, of the heights of all child nodes 
of the B-th node is defined as the height of the B-th node, 
10 and 

if the node operation controlling means determines, 
only on the C-th node, the corrected desired motion by 
adding a first correction of the desired relative heights 
of a plurality of ground contact portions belonging to the 

15 C-th node to the desired motion, then the desired height 
of the C-th node in the corrected desired motion is 
maintained at the desired height in the desired motion (a 
fourth invention) . 

According to the third invention, the desired height 

20 of each C-th node takes the weighted mean value of the 

desired heights of the child nodes of the C-th node (the 
desired heights are determined on the basis of the desired 
heights of the ground contact portions belonging to the C- 
th node in the aforesaid desired motion) . If the 

25 corrected desired motion is determined for only one 

arbitrary node among the C-th nodes by adding a first 
correction of the desired relative heights of the 



plurality of ground contact portions belonging to that one 
node to the desired motion of the aforesaid desired gait, 
then the first correction is added to a desired motion 
such that the aforesaid weighted mean value of the child 
nodes of the aforesaid one node will be the same in a 
corrected desired motion and a desired motion. 

Similarly, according to the fourth invention, if the 
corrected desired motion is determined, only on the C-th 
node, by adding a first correction of the desired relative 
heights of a plurality of ground contact portions 
belonging to the C-th node to the desired motion, then the 
first correction is added to a desired motion such that 
the aforesaid weighted mean value of the child nodes of 
the C-th node will be the same in a corrected desired 
motion and in a desired motion. 

As a result, the desired relative heights of the 
plurality of ground contact portions belonging to a C-th 
node can be corrected while achieving mutual balance among 
the floor reaction forces of the plurality of ground 
contact portions belonging to the C-th node. This 
eventually permits further improved stability of a posture 
of the robot. 

According to a fifth invention of the control device 
for a mobile body of the present invention, a control 
device for a mobile body that comprises a desired gait 
determining means for determining a desired gait composed 
of a desired motion and a desired floor reaction force of 
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a mobile body, such as a mobile robot having three or more 
ground contact portions connected through the intermediary 
of a plurality of joints such that mutual relative heights 
thereof can be manipulated, and a floor reaction force 
5 detecting means for detecting or estimating an actual 

floor reaction force acting on each of the ground contact 
portions, and controls the operation of the mobile body to 
make a gait of the mobile body follow a desired gait, 

wherein the ground contact portions are classified 

10 into a tree structure such that each of the ground contact 

portions becomes a leaf node, and an intermediate node 
exists between the leaf node and a root node having all 
the leaf nodes as descendant nodes, and 

relative to a B-th node, which is each node in the 

15 tree structure, if the B-th node is the leaf node, then a 
floor reaction force acting on a ground contact portion 
that is the leaf node is defined as the node floor 
reaction force of the B-th node, and if the B-th node has 
child nodes, then the resultant force of the node floor 

20 reaction forces of all child nodes of the B-th node is 

defined as the node floor reaction force of the B-th node, 
and further, if the point at which the horizontal 
component or a parallel-to-floor component of the moment 
of the node floor reaction force of the B-th node becomes 

25 zero is defined as the node floor reaction force central 
point of the B-th node, 

the control device for a mobile body, comprising: 
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a means for determining a desired node floor 
reaction force central point, which is the desired 
position of a node floor reaction force central point of 
each node, on the basis of at least one of the desired 
5 motion and the desired floor reaction force of the desired 
gait; 

a means for determining an actual node floor 
reaction force as the actual value of a node floor 
reaction force of each node from the actual floor reaction 
10 force of each ground contact portion that has been 

detected or estimated; and 

a node operation controlling means that determines, 

on each of the C-th nodes, which is a node having a 
plurality of ground contact portions as descendant nodes, 
15 by using, as a control amount, one of 

a difference (Mc_act-Mc_dmd) between an actual 
moment (Mc_act) , which is the moment caused by the actual 
node floor reaction force of the C-th node to act on a 
desired node floor reaction force central point of the C- 
20 th node, and a desired value (Mc_dmd) of a moment that 
should act on the desired node floor reaction force 
central point of the C-th node, 

a difference (Mc_f -Mc_dmd) between a moment (Mc_f ) , 
which is obtained by subtracting the moment caused by the 
25 actual node floor reaction force of each child node of the 
C-th node to act on a desired node floor reaction force 
central point of the child node from the actual moment 
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(Mc_act) of the C-th node, and a desired value (Mc_dmd) of 
a moment that should act on the desired node floor 
reaction force central point of the C-th node, 

a value of the difference (AP) between the position 
5 of the point at which the horizontal component or the 

parallel-to-floor component of the moment of the actual 
node floor reaction force of the C-th node becomes zero 
and the position of the desired node floor reaction force 
central point of the C-th node, and 

10 a value of the difference (APf) between the position 

of the point at which the horizontal component or the 
parallel-to-floor component of the moment, which is 
obtained by subtracting the moment caused by the actual 
node floor reaction force of each child node of the C-th 

15 node to act on the desired node floor reaction force 

central point of the child node from the moment of the 
actual node floor reaction force (Mc_act) of the C-th node, 
becomes zero and the position of the desired node floor 
reaction force central point of the C-th node, 

20 a correction amount of the desired relative heights 

of a plurality of ground contact portions belonging to the 
C-th node, for each C-th node, such that the control 
amount approximates zero on the basis of the control 
amount, and also determines, on the basis of a correction 

25 amount obtained by combining the determined correction 
amount of every C-th node, a corrected desired motion 
obtained by adding at least a first correction of the 



desired relative heights of the plurality of ground 
contact portions belonging to each C-th node to a desired 
motion of the desired gait, then operates the joints such 
that the determined corrected desired motion is satisfied. 

According to the fifth invention, three or more 
ground contact portions provided in a mobile body are 
classified into a tree structure, and the correction 
amounts (in other words, manipulated variables) of the 
desired relative heights of a plurality of ground contact 
portions belonging to the C-th node are determined for 
each C-th node such that the moment acting on a desired 
floor reaction force central point of each C-th node 
having child nodes or the aforesaid control amount related 
to the position of the desired floor reaction force 
central point approximates zero. Then, based on a 
correction amount obtained by combining those correction 
amounts of all the C-th nodes, a corrected desired motion 
is determined by adding at least a first correction of the 
desired relative heights of the plurality of ground 
contact portions belonging to each C-th node to the 
desired motion of the desired gait, and the joints of the 
mobile body are operated such that the determined 
corrected desired motion is satisfied. This makes it 
possible to adjust the relative heights of the ground 
contact portions such that the relative relationship among 
the actual node floor reaction forces of the child nodes 
of the C-th node approximates the relative relationship 



among the desired node floor reaction forces of the child 
nodes of the C-th node while accomplishing mutual balance 
of the floor reaction forces of the plurality of ground 
contact portions, as compared with a case where the 
heights of individual ground contact portions are 
independently (separately) manipulated. As a result, even 
if a floor with which a mobile body is to be in contact 
has a local unknown tilt, projection or depression, an 
influence thereof will be minimized, permitting enhanced 
stability of a posture of a robot to be achieved. 

According to a sixth invention of the control device 
for a mobile body of the present invention, a control 
device for a mobile body that comprises a desired gait 
determining means for determining a desired gait composed 
of a desired motion and a desired floor reaction force of 
a mobile body, such as a mobile robot having three or more 
ground contact portions connected through the intermediary 
of a plurality of joints such that mutual relative heights 
thereof can be manipulated, and a floor reaction force 
detecting means for detecting or estimating an actual 
floor reaction force acting on each of the ground contact 
portions, and controls the operation of the mobile body to 
make a gait of the mobile body follow a desired gait, 

wherein the ground contact portions are classified 
into a tree structure such that each of the ground contact 
portions becomes a leaf node, and an intermediate node 
exists between the leaf node and a root node having all 
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the leaf nodes as descendant nodes, and 

relative to each of B-th nodes, which is each node 
in the tree structure, if the B-th node is the leaf node, 
then a floor reaction force acting on a ground contact 
5 portion that is the leaf node is defined as the node floor 
reaction force of the B-th node, and if the B-th node has 
child nodes, then the resultant force of the node floor 
reaction forces of all child nodes of the B-th node is 
defined as the node floor reaction force of the B-th node, 

10 and further, if the point at which the horizontal 

component or a parallel-to-floor component of the moment 
of the node floor reaction force of the A-th node becomes 
zero is defined as the node floor reaction force central 
point of the B-th node, 

15 the control device for a mobile body, comprising: 

relative to a predetermined C-th node that is an 
intermediate node having a plurality of ground contact 
portions as descendant nodes, 

a means for determining a desired node floor 

20 reaction force central point, which is the desired 

position of a node floor reaction force central point of 
at least the C-th node, on the basis of at least the 
desired gait; 

a means for determining an actual node floor 

25 reaction force as the actual value of a node floor 

reaction force of at least the C-th node from the detected 
or estimated actual floor reaction force of each ground 
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contact portion; and 

a node operation controlling means that determines, 
by using, as a control amount, one of 
a difference (Mc_act-Mc_dmd) between an actual 
5 moment (Mc_act) , which is the moment caused by the actual 
node floor reaction force of the C-th node to act on a 
desired node floor reaction force central point of the C- 
th node, and a desired value (Mc_dmd) of a moment that 
should act on the desired node floor reaction force 
10 central point of the C-th node, 

a difference (Mc_f -Mc_dmd) between a moment (Mc_f ) , 
which is obtained by subtracting the moment caused by the 
actual node floor reaction force of each child node of the 
C-th node to act on a desired node floor reaction force 
15 central point of the child node from the actual moment 

(Mc_act) of the C-th node, and a desired value (Mc_dmd) of 
a moment that should act on the desired node floor 
reaction force central point of the C-th node, 

a value of the difference (AP) between the position 
20 of the point at which the horizontal component or the 

parallel-to-floor component of the moment of the actual 
node floor reaction force of the C-th node becomes zero 
and the position of the desired node floor reaction force 
central point of the C-th node, and 
25 a value of the difference (APf) between the position 

of the point at which the horizontal component or the 
parallel-to-floor component of the moment, which is 



obtained by subtracting the moment caused by the actual 
node floor reaction force of each child node of the C-th 
node to act on the desired node floor reaction force 
central point of the child node from the moment of the 
actual node floor reaction force (Mc_act) of the C-th node, 
becomes zero and the position of the desired node floor 
reaction force central point of the C-th node, 

a corrected desired motion by adding at least a 
first correction of the desired relative heights of a 
plurality of ground contact portions belonging to the C-th 
node to the desired motion of the desired gait such that 
the control amount approximates zero on the basis of the 
control amount, and operates the joints such that the 
determined corrected desired motion is satisfied. 

According to the sixth invention, three or more 
ground contact portions provided in a mobile body are 
classified into a tree structure, and a corrected desired 
motion is determined by adding at least a first correction 
of the desired relative heights of a plurality of ground 
contact portions belonging to the C-th node, which is an 
intermediate node, to the desired motion of the desired 
gait such that the moment acting on a desired floor 
reaction force central point of a certain predetermined C- 
th node or the aforesaid control amount related to the 
position of a desired floor reaction force central point 
approximates zero. Then, the joints of the mobile body 
are operated such that the determined corrected desired 
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motion is satisfied. This makes it possible to adjust the 
relative heights of the ground contact portions such that 
the relative relationship among the actual node floor 
reaction forces of the child nodes of the C-th node 
5 approximates the relative relationship among the desired 
node floor reaction forces of the child nodes of the C-th 
node while accomplishing mutual balance of the floor 
reaction forces of the plurality of ground contact 
portions, as compared with a case where the heights of 

10 individual ground contact portions are independently 

(separately) manipulated. As a result, even if a floor 
with which a mobile body is to be in contact has a local 
unknown tilt, projection or depression, an influence 
thereof will be minimized, permitting enhanced stability 

15 of a posture of a robot to be achieved. The joints of the 
mobile body are operated such that the corrected desired 
relative heights are satisfied. This makes it possible to 
manipulate the relative heights of the ground contact 
portions such that the moment acting on the desired floor 

20 reaction force central point of the C-th node or the 
aforesaid control amount related to the position of a 
desired floor reaction force central point approximates 
zero while accomplishing mutual balance of the floor 
reaction forces of the plurality of ground contact 

25 portions, as compared with a case where the heights of 
individual ground contact portions are independently 
(separately) manipulated. As a result, even if a floor 
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with which a mobile body is to be in contact has a local 
unknown tilt, projection or depression, an influence 
thereof will be minimized, permitting enhanced stability 
of a posture of a robot to be achieved. 
5 In the aforesaid fifth invention, preferably, a 

weight has been set on each node in the tree structure, 
and regarding a B-th node, which is each node in the tree 
structure, if the B-th node is the leaf node, then the 
height of a ground contact portion that is the leaf node 

10 is defined as the height of the B-th node, and if the B-th 

node has child nodes, then a weighted mean value, which 
uses the weight, of the heights of all child nodes of the 
B-th node is defined as the height of the B-th node, and 

when the node operation controlling means determines 

15 the corrected desired motion for only one arbitrary node 
among C-th nodes by adding a first correction of the 
desired relative heights of the plurality of ground 
contact portions belonging to that one node to the desired 
motion, then the desired height of that one node in the 

20 corrected desired motion is maintained at a desired height 
in the desired motion (a seventh invention) . 

Similarly, in the sixth invention, preferably, a 
weight has been set on each node in the tree structure, 
and regarding a B-th node, which is each node in the tree 

25 structure, if the B-th node is the leaf node, then the 

height of the ground contact portion that is the leaf node 
is defined as the height of the B-th node, and if the B-th 
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node has child nodes, then the weighted mean value, which 
uses the above weight, of the heights of all child nodes 
of the B-th node is defined as the height of the B-th node, 
and 

5 when the node operation controlling means determines, 

only on the C-th node, the corrected desired motion by 
adding a first correction of the desired relative heights 
of a plurality of ground contact portions belonging to the 
C-th node to the desired motion, the desired height of the 
10 C-th node in the corrected desired motion is maintained at 
the desired height in the desired motion (an eighth 
invention) . 

According to the seventh invention, the desired 
height of each C-th node takes the weighted mean value of 

15 the desired heights of the child nodes of the C-th node 
(the desired heights are determined on the basis of the 
desired heights of the ground contact portions belonging 
to the C-th node in the aforesaid desired motion) . If the 
corrected desired motion is determined for only one 

20 arbitrary node among the C-th nodes by adding a first 
correction of the desired relative heights of the 
plurality of ground contact portions belonging to that one 
node to the desired motion of the aforesaid desired gait, 
then the first correction is added to a desired motion 

25 such that the aforesaid weighted mean value of the child 
nodes of the aforesaid one node will be the same in a 
corrected desired motion and in a desired motion. 



Similarly, according to the eighth invention, if the 
corrected desired motion is determined only on the C-th 
node by adding a first correction of the desired relative 
heights of a plurality of ground contact portions 
belonging to the C-th node to the desired motion, then the 
first correction is added to a desired motion such that 
the aforesaid weighted mean value of the child nodes of 
the C-th node will be the same in a corrected desired 
motion and in a desired motion. 

As a result, the desired relative heights of the 
plurality of ground contact portions belonging to a C-th 
node can be corrected while achieving mutual balance among 
the floor reaction forces of the plurality of ground 
contact portions belonging to the C-th node. This 
eventually permits further improved stability of a posture 
of the robot. 

In the aforesaid seventh and eighth inventions, the 
means for determining a desired node floor reaction force 
central point preferably determines the desired node floor 
reaction force central points and weights of the C-th node 
and each of the descendant nodes thereof such that the 
weighted mean value, which uses the aforesaid weight, of 
the positions of the desired node floor reaction force 
central points of the child nodes of the C-th node will be 
the desired node floor reaction force central point of the 
C-th node (a ninth invention) . 

In the aforesaid fifth invention, the node operation 
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controlling means preferably determines, for each of the 
C-th nodes, the correction amounts of the desired relative 
heights of the plurality of ground contact portions 
belonging to the C-th node on the basis of a movement 
5 amount of the desired node floor reaction force central 
point of each child node of the C-th node, the movement 
amount being obtained when the desired node floor reaction 
force central point of each child node of the C-th node is 
rotated about the desired node floor reaction force 

10 central point of the C-th node by the rotational amount 

determined on the basis of at least the aforesaid control 
amount (a tenth invention) . 

Similarly, in the aforesaid sixth invention, the 
node operation controlling means preferably determines the 

15 aforesaid corrected desired motion obtained by adding a 
first correction of the desired relative heights of the 
plurality of ground contact portions belonging to the C-th 
node to the desired motion on the basis of the movement 
amount of the desired node floor reaction force central 

20 point of each child node of the C-th node, the movement 

amount being obtained when the desired node floor reaction 
force central point of each child node of the C-th node is 
rotated about the desired node floor reaction force 
central point of the C-th node by the rotational amount 

25 determined on the basis of at least the aforesaid control 
amount (an eleventh invention) . 

Similarly, in the aforesaid seventh invention, the 
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node operation controlling means preferably determines a 
corrected desired motion, which is obtained by adding a 
first correction of the desired relative heights of the 
plurality of ground contact portions belonging to the C-th 
5 node to the desired motion, by manipulating the mutual 
relative heights of the child nodes of the C-th node on 
the basis of a movement amount of the desired node floor 
reaction force central point of each child node of the C- 
th node, the movement amount being obtained when the 

10 desired node floor reaction force central point of each 
child node of the C-th node is rotated about the desired 
node floor reaction force central point of the C-th node 
by a rotational amount determined on the basis of at least 
the aforesaid control amount (a twelfth invention) . 

15 These tenth to twelfth inventions make it possible 

to easily determine a first correction of the relative 
heights of the plurality of ground contact portions 
belonging to the C-th node such that the desired height of 
the C-th node will be the same in a corrected desired 

20 motion and in a desired motion (the desired height of the 
C-th node in the corrected desired motion will be 
maintained at a desired height in a desired motion) . 

In the third, the fourth, the seventh, and the 
eighth inventions described above, relative to each node 

25 having child nodes in the aforesaid tree structure, the 

weights of all child nodes of the each node are preferably 
set such that the total sum of the weights of all the 
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child nodes becomes one (a thirteenth invention) . 

Further, preferably, the third, the fourth, the 
seventh, and the eighth inventions described above 
comprise a means for variably setting the weight of the 
5 aforesaid each node, wherein if a leaf node corresponding 
to each ground contact portion not in contact with ground 
is defined as a D-th node, then the aforesaid means for 
setting weights sets the weight of each D-th node or the 
weight of at least one node of the ancestor nodes of the 

10 D-th node to zero (a fourteenth invention) . 

The fourteenth invention makes it possible to 
prevent wasteful corrections of the heights of ground 
contact portions not in contact with the ground, which 
cannot contribute to bringing the relative relationship 

15 among the actual node floor reaction forces of the child 
nodes of a C-th node close to the relative relationship 
among the desired node floor reaction forces of the child 
nodes of the C-th node or bringing the aforesaid control 
amount to zero. Incidentally, the fourteenth invention 

20 may be combined with the thirteenth invention. 

Further, preferably, the first, the second, the 
fifth, and the sixth inventions described above (or the 
first to the fourteenth inventions) comprise an actual 
posture inclination detecting means for detecting or 

25 estimating the actual posture inclination of a 

predetermined portion, such as the base body, of the 
aforesaid mobile body, 
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wherein, when determining the aforesaid corrected 
desired motion, the node operation controlling means 
determines the aforesaid corrected desired motion by 
further adding, to the aforesaid desired motion, a 
5 correction of the desired relative heights of the 

plurality of ground contact portions belonging to the 
aforesaid C-th node on the basis of a difference between 
the aforesaid actual posture inclination and the desired 
posture inclination of the aforesaid predetermined portion 
10 in the desired motion of the aforesaid desired gait such 

that the difference approximates zero (a fifteenth 
invention) . 

According to the fifteenth invention, the aforesaid 
corrected desired motion is determined by further adding a 

15 correction of the desired relative heights of a plurality 
of ground contact portions belonging to a C-th node to a 
desired motion such that the aforesaid posture inclination 
error approximates zero; therefore, the stability of the 
posture of a robot can be further enhanced. 

20 Further, especially the fifth invention and the 

sixth inventions described above may comprise an actual 
posture inclination detecting means for detecting or 
estimating the actual posture inclination of a 
predetermined portion, such as the base body, of the 

25 aforesaid mobile body, 

wherein the aforesaid node operation controlling 
means may comprise a means for correcting at least either 
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the desired value of the moment that should act on the 
aforesaid desired node floor reaction force central point 
of the aforesaid C-th node or the desired node floor 
reaction force central point of the C-th node on the basis 
5 of a posture inclination error, which is the difference 
between the aforesaid actual posture inclination and the 
desired posture inclination of the aforesaid predetermined 
portion in the aforesaid desired motion, such that the 
posture inclination error approximates zero, and it may 

10 determine the aforesaid control amount by using the 
aforesaid desired value of a moment or the aforesaid 
desired node floor reaction force central point, which has 
been corrected, in place of the desired value of a moment 
or a desired node floor reaction force central point 

15 before the correction (a sixteenth invention) . 

According to the sixteenth invention, the desired 
value of a moment that should act on the desired floor 
reaction force central point of a C-th node or the 
position of the desired floor reaction force central point 

20 is corrected such that the aforesaid posture inclination 
error approximates zero, and then the corrected moment 
desired value or desired node floor reaction force central 
point is used in place of the moment desired value or 
desired node floor reaction force central point before the 

25 correction to determine the aforesaid control amount, 

zero; therefore, a corrected desired motion is determined 
by adding a first correction related to the aforesaid C-th 
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node for bringing the control amount close to zero to a 
desired motion. As a result, the stability of the posture 
of a mobile body can be enhanced while properly 
controlling a floor reaction force acting on the mobile 
5 body such that the aforesaid posture inclination error 

approximates zero. Incidentally, the sixteenth invention 
may be combined with the seventh to the fourteenth 
inventions described above. 

Further, the fifth invention and the sixth invention 
10 preferably have the aforesaid ground contact portions 
connected to a base body of the aforesaid mobile body 
through the intermediary of connection mechanisms such 
that they are movable with respect to the base body, and 
comprise : 

15 a desired node floor reaction force distributing 

means for determining, on each E-th node, which is a node 
having child nodes in the aforesaid tree structure, the 
translational force component of a desired node floor 
reaction force of each leaf node belonging to the E-th 

20 node on the basis of at least the desired floor reaction 
force of the aforesaid desired gait such that the 
horizontal component or the parallel-to-floor component of 
a moment caused by a desired node floor reaction force, 
which is the desired value of the E-th node floor reaction 

25 force, to act on the aforesaid desired node floor reaction 
force central point of the E-th node becomes zero, 

wherein the aforesaid node operation controlling 



- 32 - 



means comprises a means for estimating, on the basis of at 
least the translational force component of a desired node 
floor reaction force of each leaf node belonging to the 
aforesaid C-th node, the amount of a deformation that 
5 occurs in the connecting mechanism between the aforesaid 

base body and each ground contact portion belonging to the 
C-th node and in the ground contact portion when the 
translational force component of the desired node floor 
reaction force acts on the ground contact portion 

10 belonging to the C-th node, and when determining the 
aforesaid corrected desired motion, it determines the 
aforesaid corrected desired motion by further adding, to 
the aforesaid desired motion, a second correction of the 
desired height of each of a plurality of ground contact 

15 portions belonging to the aforesaid C-th node to cancel 

the aforesaid estimated deformation amount (a seventeenth 
invention) . 

The seventeenth invention considers deformations, 
such as flexure, taking place in the aforesaid connecting 

20 mechanisms or ground contact portions due to floor 

reaction forces applied when the ground contact portions 
come in contact with the ground, and estimates the 
deformation amounts on the basis of the translational 
force components of the desired node floor reaction forces 

25 of leaf nodes (ground contact portions) . Then, a second 
correction of the desired height of each of the plurality 
of ground contact portions belonging to the aforesaid C-th 
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node is further added to the aforesaid desired motion to 
cancel the estimated deformation amount, thereby 
determining a corrected desired motion. Thus, according 
to the seventeenth invention, proper floor reaction forces 
5 can be applied to a mobile body while compensating for the 
influences of deformations of connecting mechanisms or 
ground contact portions, thus making it possible to 
further enhance the stability of a posture of the mobile 
body. 

10 Preferably, the third, the fourth, the seventh, and 

the eighth inventions described above have the aforesaid 
ground contact portions connected to the base body of the 
aforesaid mobile body through the intermediary of 
connecting mechanisms such that they are movable with 

15 respect to the base body, and comprise: 

a desired node floor reaction force distributing 
means that determines, on each of E-th nodes, which is a 
node having a parent node in the aforesaid tree structure, 
the translational force component of a desired node floor 

20 reaction force of the E-th node on the basis of at least 
the desired floor reaction force of the aforesaid desired 
gait such that the translational force component of a 
desired node floor reaction force, which is the desired 
value of the E-th node floor reaction force, takes a value 

25 obtained by multiplying the translational force component 
of a desired node floor reaction force of the parent node 
of the E-th node by the aforesaid weight of the E-th node, 



wherein the aforesaid node operation controlling 
means comprises a means for estimating, on the basis of at 
least the translational force component of a desired node 
floor reaction force of each leaf node belonging to the 
aforesaid C-th node, the amounts of deformations that 
occur in the connecting mechanisms between the aforesaid 
base body and the ground contact portions belonging to the 
C-th node and in the ground contact portions when the 
translational force component of the desired node floor 
reaction force acts on the ground contact portions 
belonging to the C-th node, and when determining the 
aforesaid corrected desired motion, it determines the 
aforesaid corrected desired motion by further adding, to 
the aforesaid desired motion, a second correction of the 
desired height of each of a plurality of ground contact 
portions belonging to the aforesaid C-th node to cancel 
the aforesaid estimated deformation amounts (an eighteenth 
invention) . 

As with the seventeenth invention, the eighteenth 
invention considers deformations, such as flexure, taking 
place in the aforesaid connecting mechanisms or ground 
contact portions due to floor reaction forces applied when 
the ground contact portions come in contact with the 
ground, and estimates the deformation amounts on the basis 
of the translational force components of the desired node 
floor reaction forces of leaf nodes (ground contact 
portions) . Then, a second correction of the desired 
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height of each of the plurality of ground contact portions 
belonging to the aforesaid C-th node is further added to 
the aforesaid desired motion to cancel the estimated 
deformation amount, thereby determining the aforesaid 
5 corrected desired motion. Hence, according to the 

eighteenth invention, proper floor reaction forces can be 
applied to a mobile body while compensating for the 
influences of deformations of connecting mechanisms or 
ground contact portions, thus making it possible to 
10 further enhance the stability of a posture of the mobile 

body . 

Supplementally, the desired node floor reaction 

force distributing means in the aforesaid seventeenth 

invention and the desired node floor reaction force 
15 distributing means in the aforesaid eighteenth invention 

will eventually determine the desired node floor reaction 

force of a leaf node in the same manner. 

Further, preferably, the fifth and the sixth 

inventions described above have the ground contact 
20 portions connected to the base body of the mobile body 

through the intermediary of connecting mechanisms such 

that they are movable with respect to the base body, and 

further comprise: 

an actual posture inclination detecting means for 
25 detecting or estimating the actual posture inclination of 

a predetermined portion, such as the base body, of the 

aforesaid mobile body; 



a means for correcting at least the desired node 
floor reaction force central point of the aforesaid C-th 
node on the basis of a posture inclination error, which is 
the difference between the actual posture inclination and 
the desired posture inclination of the aforesaid 
predetermined portion in the aforesaid desired motion, 
such that the posture inclination error approximates zero; 
and 

a desired node floor reaction force distributing 
means that determines at least the translat ional force 
component of a desired node floor reaction force, which is 
the desired value of the node floor reaction force of each 
descendant node of the aforesaid C-th node, out of the 
desired node floor reaction force, which is the desired 
value of the node floor reaction force of each node, on 
the basis of at least the desired floor reaction force of 
the aforesaid desired gait such that the horizontal 
component or the parallel-to-floor component of the moment 
of a desired node floor reaction force acting on the 
aforesaid corrected desired node floor reaction force 
central point of the C-th node becomes zero, 

wherein the aforesaid node operation controlling 
means comprises a means for estimating, on the basis of at 
least the translational force component of a desired node 
floor reaction force of each leaf node belonging to the 
aforesaid C-th node, the amounts of deformations that 
occur in the connecting mechanisms between the aforesaid 
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base body and the ground contact portions belonging to the 
C-th node and in the ground contact portions when the 
translational force component of the desired node floor 
reaction force acts on the ground contact portions 
5 belonging to the C-th node, and when determining the 
aforesaid corrected desired motion, it determines the 
aforesaid control amount by using the aforesaid corrected 
desired node floor reaction force central point of the C- 
th node in place of the desired node floor reaction force 

10 central point before the correction and also determines 

the aforesaid corrected desired motion by further adding, 
to the aforesaid desired motion, a second correction of 
the desired height of each of a plurality of ground 
contact portions belonging to the aforesaid C-th node to 

15 cancel the aforesaid estimated deformation amounts (a 
nineteenth invention) . 

Alternatively, when the aforesaid ground contact 
portions are connected to the base body of the aforesaid 
mobile body through the intermediary of connecting 

20 mechanisms such that they are movable with respect to the 
base body, preferably, the fifth and the sixth inventions 
described above comprise: 

an actual posture inclination detecting means for 
detecting or estimating the actual posture inclination of 

25 a predetermined portion, such as the base body, of the 
aforesaid mobile body; 

a means for determining the desired value of a 



moment that should act on the desired floor reaction force 
central point of at least the aforesaid C-th node on the 
basis of a posture inclination error, which is the 
difference between the aforesaid actual posture 
inclination and the desired posture inclination of the 
aforesaid predetermined portion in the aforesaid desired 
motion, such that the posture inclination error 
approximates zero; and 

a desired node floor reaction force distributing 
means that determines at least the translat ional force 
component of a desired node floor reaction force, which is 
the desired value of a node floor reaction force of each 
descendant node of the aforesaid C-th node, out of the 
desired node floor reaction force, which is the desired 
value of a node floor reaction force of each node, on the 
basis of at least a floor reaction force of the aforesaid 
desired gait such that the moment of a desired node floor 
reaction force acting on the aforesaid desired node floor 
reaction force central point of the C-th node becomes the 
aforesaid determined desired value, 

wherein the aforesaid node operation controlling 
means comprises a means for estimating, on the basis of at 
least the translational force component of a desired node 
floor reaction force of each leaf node belonging to the 
aforesaid C-th node, the amount of a deformation that 
occurs in a connecting mechanism between the aforesaid 
base body and each ground contact portion belonging to the 
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C-th node and in the ground contact portion when the 
translational force component of the desired node floor 
reaction force acts on each ground contact portion 
belonging to the C-th node, and when determining the 
5 aforesaid corrected desired motion, it determines the 

aforesaid control amount by using the aforesaid determined 
desired value of the moment of the C-th node and also 
determines the aforesaid corrected desired motion by 
further adding, to the aforesaid desired motion, a second 

10 correction of the desired height of each of a plurality of 

ground contact portions belonging to the aforesaid C-th 
node to cancel the aforesaid estimated deformation amount 
(a twentieth invention) . 

According to the nineteenth invention and the 

15 twentieth invention, as with the aforesaid sixteenth 

invention, the first correction of the desired relative 
heights of the ground contact portions belonging to the C- 
th node is added to a desired motion such that the 
aforesaid control amount that contains a correction for 

20 bringing the aforesaid posture inclination error close to 
zero approximates zero. At the same time, as with the 
aforesaid seventeenth invention, the second correction of 
the desired heights of the ground contact portions 
belonging to the C-th node is further added to the desired 

25 motion so as to determine a corrected desired motion. 
Thus, according to the nineteenth and the twentieth 
inventions, proper floor reaction forces can be applied to 
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a mobile body while compensating for the influences of 
deformations of connecting mechanisms or ground contact 
portions and also making the aforesaid posture inclination 
error approximate zero, thus making it possible to further 
5 enhance the stability of a posture of the mobile body. 

Further, when the aforesaid ground contact portions 
are connected to the base body of the aforesaid mobile 
body through the intermediary of connecting mechanisms 
such that they are movable with respect to the base body, 

10 the third, the fourth, the seventh, and the eighth 

inventions described above, in which a weight has been set 
on each node, preferably comprise: 

an actual posture inclination detecting means for 
detecting or estimating the actual posture inclination of 

15 a predetermined portion, such as the base body, of the 
aforesaid mobile body; 

a means for correcting at least the weight of each 
descendant node of the aforesaid C-th node on the basis of 
the posture inclination error, which is the difference 

20 between the aforesaid actual posture inclination and the 
desired posture of the aforesaid predetermined portion in 
the aforesaid desired motion, such that the posture 
inclination error approximates zero; and 

a desired node floor reaction force distributing 

25 means that determines at least the translational force 

component of a desired node floor reaction force, which is 
the desired value of a node floor reaction force of each 
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descendant node of the aforesaid C-th node, out of the 
desired node floor reaction force, which is the desired 
value of the node floor reaction force of each node, on 
the basis of at least a desired floor reaction force of 
5 the aforesaid desired gait such that it takes a value 

obtained by multiplying the translational force component 
of a desired node floor reaction force of a parent node of 
each descendant node by the aforesaid corrected weight of 
the descendant node, 

10 wherein the node operation controlling means 

comprises a means for estimating, on the basis of at least 
the translational force component of a desired node floor 
reaction force of each leaf node belonging to the 
aforesaid C-th node, the amount of a deformation that 

15 occurs in a connecting mechanism between the aforesaid 

base body and each ground contact portion belonging to the 
C-th node and in the ground contact portion when the 
translational force component of the desired node floor 
reaction force acts on each ground contact portion 

20 belonging to the C-th node, and when determining the 
aforesaid corrected desired motion, it determines the 
aforesaid corrected desired motion by further adding, to 
the aforesaid desired motion, a second correction of the 
desired height of each of a plurality of ground contact 

25 portions belonging to the C-th node to cancel the 

estimated deformation amount (an twenty-first invention) . 

According to this twenty-first invention, the weight 



- 42 - 



of each descendant node of the C-th node is corrected such 
that a posture inclination error approximates zero; 
therefore, the weight is used to determine a corrected 
desired motion by adding the first correction of the 
5 desired relative heights of the ground contact portions 

belonging to the C-th node to a desired motion, as in the 
third, the fourth, the seventh, and the eighth inventions 
described above, thereby determining a corrected desired 
motion such that a proper floor reaction force acts on a 

10 mobile body while bringing a posture inclination error 
close to zero. At the same time, as with the aforesaid 
eighteenth invention, the second correction of the desired 
heights of the ground contact portions belonging to the C- 
th node is further added to the desired motion to 

15 determine a corrected desired motion. Thus, the corrected 
desired motion is the desired motion that has been 
corrected to cancel the deformation amounts of the 
aforesaid connecting mechanisms or ground contact portions. 
Hence, according to the twenty-first invention, as with 

20 the nineteenth and the twentieth inventions, proper floor 
reaction forces can be applied to a mobile body while 
compensating for the influences of deformations of 
connecting mechanisms or ground contact portions and also 
making the aforesaid posture inclination error approximate 

25 zero, thus making it possible to further enhance the 
stability of a posture of the mobile body. 

Supplementally, the desired node floor reaction 
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force distributing means in the aforesaid twenty-first 
invention, the desired node floor reaction force 
distributing means in the aforesaid nineteenth invention, 
and the desired node floor reaction force distributing 
5 means in the aforesaid twentieth invention will eventually 
determine the desired node floor reaction force of a leaf 
node in the same manner. 

Further, in the first invention and the fifth 
inventions described above, if the aforesaid ground 

10 contact portions are connected to the base body of the 

aforesaid mobile body such that they are movable with 
respect to the base body, then, when determining the 
aforesaid corrected desired motion, the aforesaid node 
operation controlling means preferably determines the 

15 corrected desired motion by further adding, to the 
aforesaid desired motion, a correction of a desired 
posture of the aforesaid base body to restrain slippages, 
such as twists, of the ground contact portions belonging 
to the aforesaid C-th node on a floor surface (a twenty- 

20 second invention) . This applies also to the second 
invention and the sixth invention described above (a 
twenty-third invention) . 

If many ground contact portions are connected to the 
base body of a mobile body, insufficient degrees of joints 

25 of the mobile body result, mechanically restricting the 

corrections of the relative heights of the ground contact 
portions. Hence, if the joints are forcibly operated to 
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satisfy determined desired relative heights, then 
slippages, such as twists, may occur at some ground 
contact portions. And, in such a situation wherein 
slippages occur, there is a danger in that inappropriate 
5 floor reaction forces of the ground contact portions will 

result and the stability of a posture of a robot will be 
impaired. In such a case, as with the twenty-second 
invention and the twenty-third invention, the aforesaid 
slippages, such as twists, can be restrained by further 

10 adding a correction of a desired posture of the base body 

to a desired motion in determining the aforesaid corrected 
desired motion. Thus, the stability of the posture of the 
mobile body can be secured while adjusting those floor 
reaction forces to appropriate ones so that no undue floor 

15 reaction forces act on ground contact portions. 

In the aforesaid twenty-second invention, further 
preferably, the aforesaid node operation controlling means 
determines the aforesaid corrected desired motion such 
that the direction of the segment that connects the 

20 desired overall floor reaction force central point of the 
aforesaid mobile body, which depends on a desired floor 
reaction force of the aforesaid desired gait, and the 
overall center-of -gravity of the aforesaid mobile body or 
a predetermined representative point of the base body of 

25 the mobile body in the aforesaid corrected desired motion 
is substantially identical to the direction of the segment 
in the aforesaid desired gait (a twenty-fourth invention) . 



And, this applies also to the aforesaid twenty-third 
invention (a twenty-fifth invention) . 

According to these twenty-fourth and twenty-fifth 
inventions, it is possible to prevent the direction of the 
resultant force of the gravitational force and an inertial 
force acting on a mobile body from considerably deviating 
from an appropriate direction in a desired gait when a 
desired motion is corrected by further adding a correction 
of a desired posture of the base body, so that the 
aforesaid corrected desired motion can be determined while 
properly maintaining the stability of the mobile body. 

Alternatively, in the aforesaid twenty-second 
invention, the aforesaid node operation controlling means 
may determine the aforesaid corrected desired motion such 
that the horizontal position of the overall center-of- 
gravity of the aforesaid mobile body or the horizontal 
position of a predetermined representative point of the 
base body of the mobile body in the aforesaid corrected 
desired motion is substantially identical to the 
horizontal position in the aforesaid desired motion (a 
twenty-sixth invention) . And, this applies also to the 
aforesaid twenty-third invention (a twenty-seventh 
invention) . 

According to these twenty-sixth and twenty-seventh 
inventions, it is possible to prevent the overall center- 
of-gravity of a mobile body from considerably deviating in 
the horizontal direction relative to an appropriate 
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position in a desired gait when a corrected desired motion 
is determined by adding a second correction of a desired 
posture of the base body to a desired motion, so that the 
relative heights of the ground contact portions of a C-th 
5 node and the posture of the base body can be corrected 
while properly maintaining the stability of the mobile 
body. 

Further, the twenty-second invention is suited to a 
case where the aforesaid mobile body is a robot equipped 

10 with a plurality of link mechanisms extended from its base 
body, and at least one link mechanism among the plurality 
of link mechanisms is provided with a joint at least in an 
intermediate portion thereof between its distal end and 
its end adjacent to the base body, and the intermediate 

15 portion is the aforesaid ground contact portion (a twenty- 
eighth invention) . 

Similarly, the twenty-third invention is suited to a 
case where the aforesaid mobile body is a robot equipped 
with a plurality of link mechanisms extended from its base 

20 body, and at least one link mechanism among the plurality 
of link mechanisms is provided with a joint at least in an 
intermediate portion between its distal end and its end 
adjacent to the base body, and the intermediate portion is 
a ground contact portion belonging to the aforesaid C-th 

25 node (a twenty-ninth invention) . 

More specifically, normally, a robot having a 
plurality of link mechanisms extended from its base body 
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usually comes in contact with the ground at the distal end 
portions of the link mechanisms; therefore, if an attempt 
were made to make it come in contact with the ground at an 
intermediate portion of the link mechanism (e.g., if an 
5 attempt were made to make human-like mobile robot come in 
contact with the ground at an intermediate portion of a 
leg (knee) thereof), then the joint would develop an 
insufficient degree of freedom, possibly causing a 
slippage, such as a twist, as mentioned above. Thus, the 

10 twenty-second invention and the twenty-third invention are 

suited to cases where a mobile body is constructed as 
described in the twenty-eighth invention and the twenty- 
ninth invention, respectively. 

In the aforesaid twenty-eighth invention, the 

15 aforesaid intermediate portion is preferably provided with 
an elastic member that resiliently deforms when coming 
into contact with the ground (a thirtieth invention) . And, 
this applies also to the aforesaid twenty-ninth invention 
(a thirty-first invention) . 

20 This enhances the capability of adjusting floor 

reaction forces by correcting the relative heights of the 
aforesaid intermediate portions, making it easier to 
secure the stability of the posture of a mobile body 
(robot) . 

25 Further, the aforesaid twenty-second invention is 

suited to a case where the aforesaid mobile body is 
provided with a plurality of link mechanisms extended from 
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its base body, each of which having one or more joints, at 
least one link mechanism among the aforesaid link 
mechanisms and the aforesaid base body are provided with 
ground contact portions, and ground contact portions that 
5 belong to at least one of the aforesaid C-th nodes include 
at least a ground contact portion of the aforesaid base 
body and ground contact portions of one or more link 
mechanisms among the aforesaid plurality of link 
mechanisms (a thirty-second invention) . 

10 Similarly, the aforesaid twenty-third invention is 

suited to a case where the aforesaid mobile body is 
provided with a plurality of link mechanisms extended from 
the base body, each of which having one or more joints, at 
least one link mechanism among the aforesaid link 

15 mechanisms and the aforesaid base body are provided with 
ground contact portions, and the ground contact portions 
that belong to the aforesaid C-th node include at least a 
ground contact portion of the aforesaid base body and 
ground contact portions of one or more link mechanisms 

20 among the aforesaid plurality of link mechanisms (a 
thirty-third invention) . 

For example, if a robot having one or more legs 
(link mechanisms) extended from its base body (upper body 
or the like) is to perform a sitting operation, it will 

25 have its base body to come in contact. In such a case, 

the degree of freedom of a joint will be insufficient, and 
its base body will come in contact, and if this happens, 



- 49 - 



the aforesaid slippage, such as a twist, may take place. 
Accordingly, the twenty-second invention and the twenty- 
third invention are suited also to cases where mobile 
bodies are constructed as described in the thirty-second 
5 invention and the thirty-third invention, respectively. 

In the aforesaid thirty-second invention, a ground 
contact portion of the aforesaid base body is preferably 
provided with an elastic member that resiliently deforms 
when coming into contact with the ground (a thirty-fourth 

10 invention) . And, this applies also to the aforesaid 

thirty-third invention (a thirty-fifth invention) . 

This enhances the capability of adjusting floor 
reaction forces by correcting the relative heights of the 
ground contact portions in the aforesaid base body, making 

15 it easier to secure the stability of the posture of a 
mobile body. 

The twenty-second to the thirty-fifth inventions 
described above may be combined with the third, the fourth, 
or the seventh to the twenty-first inventions, as 
20 necessary. 

In the first, the second, the fifth, and the sixth 
inventions (or the first to the thirty-fifth inventions) , 
a weight has been set on each node in the aforesaid tree 
structure, and 

25 if processing in which, when a predetermined type of 

state amount, such as a height or a floor reaction force, 
is associated with each leaf node in the aforesaid tree 
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structure, the state amount of each node having child 
nodes is defined as a weighted mean value, which uses the 
aforesaid weight, of the state amounts of all child nodes 
of the node, a value obtained by subtracting a state 
5 amount of a parent node of the node from the state amount 
of the node is determined as a node relative state amount 
of the node on each node except a root node, and zero is 
determined as a relative state amount of the root node, is 
defined as the processing for hierarchically relativizing 

10 the predetermined type of state amount on each node, 

if a node relative floor reaction force 
Fn_rel (n=l, 2, ...) hierarchically relativized on each node 
is determined on the basis of a floor reaction force 
Fn (n=l, 2, ...) acting on each of the ground contact portions, 

15 which are the leaf nodes, and when a vector 

(Fal_rel, Fa2_rel, Far_rel) having, as its elements, the 
node relative floor reaction forces of all child nodes aj 
( j =1 , 2 , . .. , r . r denotes the total number of the child nodes 
of an n-th node) of an n-th node, which is an arbitrary 

20 node having child nodes, is represented by a linear 
linkage of a plurality of predetermined mutually 
independent vectors R(j) ( j = 1 , 2 , . . . , r- 1 ) that are all 
orthogonal to a vector (Wal , Wa2 , . . . , War ) having the weights 
of all child nodes of the n-th node as its elements, a 

25 vector having a coefficient of the linear linkage as its 
element is defined as a node expansion floor reaction 
force moment Mn_exp of the n-th node, and 
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if a node relative height Zn_rel (n=l , 2 , . . . ) 
hierarchically relativized on each node is determined on 
the basis of a height Zn (n=l, 2, ...) of each of the ground 
contact portions, which are the aforesaid leaf nodes, and 
5 when a vector (Zal_rel, Za2_rel , . . . , Zar_rel ) having the 

node relative heights of all child nodes aj ( j=l, 2, r . r 
denotes the total number of the child nodes of an n-th 
node) of the aforesaid n-th node as its elements is 
expressed by a linear linkage of the plurality of the 

10 predetermined mutually independent vectors 

R(j) ( j =1 , 2 , ... , r-1 ) , a vector having a coefficient of the 
linear linkage as its element is defined as a node 
expansion inclination angle 8n of the n-th node, 

then, the aforesaid node operation controlling means 

15 may determine the aforesaid corrected desired motion by 
adding, to the aforesaid desired motion, a first 
correction of the desired relative heights of a plurality 
of ground contact portions belonging to the C-th node by 
using the aforesaid node expansion floor reaction force 

20 moment Mn_exp (n=C) or a node expansion inclination angle 
0n(n=C) of at least the aforesaid C-th node (a thirty- 
sixth invention) . 

Using the node expansion floor reaction force moment 
or the node expansion inclination angle defined as 

25 described above makes it possible to properly correct the 
desired relative heights of a plurality of ground contact 
portions belonging to a C-th node even if there are four 
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or more ground contact portions that belong to the C-th 
node . 

To be more specific, the thirty-sixth invention 
comprises a means for determining a desired floor reaction 
5 force that should act on each ground contact portion 

belonging to at least the aforesaid C-th node on the basis 
of at least the desired floor reaction force of the 
aforesaid desired gait, 

wherein the aforesaid node operation controlling 

10 means comprises a means for determining a desired node 
expansion moment, which is a desired value of the 
aforesaid node expansion moment of the C-th node, on the 
basis of a desired floor reaction force of each ground 
contact portion belonging to the aforesaid C-th node, a 

15 means for determining an actual node expansion moment, 

which is an actual value of the aforesaid node expansion 
moment of the C-th node on the basis of an actual floor 
reaction force of each ground contact portion belonging to 
the aforesaid C-th node, and a means for determining a 

20 manipulated variable of the aforesaid node expansion 

inclination angle of the aforesaid C-th node on the basis 
of the aforesaid actual node expansion moment and the 
aforesaid desired node expansion moment, and determines 
the aforesaid corrected desired motion by adding, to the 

25 aforesaid desired motion, a first correction of the 

desired relative heights of a plurality of ground contact 
portions belonging to the aforesaid C-th node on the basis 



of the aforesaid determined manipulated variable of the 
node expansion inclination angle (a thirty-seventh 
invention) . 

According to the thirty-seventh invention, when the 
manipulated variable of the aforesaid node expansion 
inclination angle of the aforesaid C-th node is determined 
on the basis of the aforesaid actual node expansion moment 
and the aforesaid desired node expansion moment (e.g., in 
order to bring their errors close to zero) , the 
manipulated variable represents the manipulated variable 
of the relative heights the child nodes of the C-th node. 
Thus, based on the manipulated variable of the node 
expansion inclination angle, a corrected desired motion 
can be properly determined by adding, to a desired motion, 
the first correction of the desired relative heights of 
the plurality of ground contact portions belonging to the 
C-th node. 

Further, the first, the second, the fifth, and the 
sixth inventions described above (or the first to the 
thirty-seventh inventions) preferably comprise a floor 
configuration estimating means for estimating a parameter 
that specifies the relative heights of the ground contact 
surfaces of a plurality of ground contact portions 
belonging to at least the aforesaid C-th node as the floor 
configuration parameter that represents a floor 
configuration, 

wherein the node operation controlling means 
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determines the aforesaid corrected desired motion by 
further adding a third correction of the desired relative 
heights of a plurality of the ground contact portions 
belonging to the aforesaid C-th node on the basis of an 
5 estimated value of the aforesaid floor configuration 

parameter when determining the aforesaid corrected desired 
motion (a thirty-eighth invention) . 

According to the thirty-eighth invention, a third 
correction of the desired relative heights of a plurality 

10 of the ground contact portions belonging to the C-th node, 

which is based on an estimated value of a floor 
configuration parameter that specifies the relative 
heights of the ground contact surfaces of a plurality of 
ground contact portions belonging to at least the C-th 

15 node, is further added to a desired motion; therefore, 

even if an actual floor configuration differs from the one 
assumed in the aforesaid desired motion, it is possible to 
make the ground contact surfaces of the ground contact 
portions properly come in contact with the actual floor 

20 surface when they should come in contact with it and 

consequently to cause a proper floor reaction force to act 
on a mobile body. Hence, the stability of a posture of 
the mobile body can be further enhanced. 

The thirty-eighth invention preferably comprises a 

25 means for determining an actual node floor reaction force, 
which is the actual value of the node floor reaction force 
of each child node of at least the aforesaid C-th node, 
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from the actual floor reaction force of each ground 
contact portion belonging to the C-th node, 

wherein the aforesaid floor configuration estimating 
means performs estimation while sequentially updating the 
5 aforesaid floor configuration parameter on the basis of a 
past value of an estimated value of the aforesaid floor 
configuration parameter, a difference between the 
aforesaid corrected desired motion and the aforesaid 
desired motion, the aforesaid corrected motion, at least 

10 either a detected value or an estimated value of an actual 
joint displacement, which is a displacement amount of each 
joint of the aforesaid mobile body, the aforesaid actual 
posture inclination, and a relative relationship among the 
actual node floor reaction forces of child nodes of at 

15 least the aforesaid C-th node (a thirty-ninth invention) . 

Alternatively, when the aforesaid ground contact 
portions are connected to the base body of the aforesaid 
mobile body through the intermediary of connecting 
mechanisms such that they are movable with respect to the 

20 base body, preferably, the thirty-ninth invention 
comprises a deformation amount detecting means for 
detecting or estimating the amounts of deformations taking 
place in the connecting mechanisms between the base body 
and the ground contact portions belonging to the aforesaid 

25 C-th node and in the ground contact portions, 

wherein the aforesaid floor configuration estimating 
means performs estimation while sequentially updating the 
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aforesaid floor configuration parameter on the basis of a 
past value or an estimated value of the aforesaid floor 
configuration parameter, a difference between the 
aforesaid corrected desired motion and the aforesaid 
5 desired motion, the aforesaid corrected motion, at least 

either a detected value or an estimated value of an actual 
joint displacement, which is a displacement amount of each 
joint of the aforesaid mobile body, the aforesaid actual 
posture inclination, and the aforesaid deformation amounts 

10 associated with the ground contact portions belonging to 

at least the aforesaid C-th node (a fortieth invention) . 

According to the thirty-ninth invention and the 
fortieth invention, it is possible to properly perform the 
estimation while sequentially updating the aforesaid floor 

15 configuration parameter in real time. Supplementally, in 
the fortieth invention, it is not necessarily required 
that all of the aforesaid connecting mechanisms be 
provided with joints. 

In the fortieth invention, the aforesaid deformation 

20 amount detecting means, for example, estimates the 

aforesaid deformation amounts on the basis of the actual 
floor reaction forces of ground contact portions (a forty- 
first invention) . 

Detecting or estimating actual floor reaction forces 

25 as described above and using them make it possible to 

properly estimate the deformation amounts of the aforesaid 
connecting mechanisms and ground contact portions. 
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In the aforesaid thirty-eighth invention (or the 
thirty-eighth to the forty-first inventions) , a weight of 
each node in the aforesaid tree structure has been set, 
and relative to a B-th node, which is each node in the 
5 tree structure, if the B-th node is the aforesaid leaf 

node, then the height of the ground contact surface of a 
ground contact portion that is the leaf node is defined as 
the height of the ground contact surface of the B-th node, 
and if the B-th node has child nodes, then a weighted mean 

10 value, which uses the aforesaid weight, of the heights of 
the ground contact surfaces of all child nodes of the B-th 
node is defined as the height of the ground contact 
surface of the B-th node, and 

the aforesaid floor configuration parameter 

15 estimated by the aforesaid floor configuration estimating 
means is preferably a parameter that specifies the 
relative relationship among the heights of the ground 
contact surfaces of a plurality of child nodes of the 
aforesaid C-th node (a forty-second invention) . 

20 According to the forty-second invention, the 

aforesaid floor configuration parameter related to the 
configuration of a floor with which the plurality of 
ground contact portions belonging to the C-th node comes 
in contact can be determined on the basis of the relative 

25 relationship of the heights of the ground contact surfaces 
of the plurality of descendant nodes of the aforesaid C-th 
node by defining the height of the ground contact surface 
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of the B-th node having child nodes as the weighted mean 
value of the child nodes, as described above. Thus, a 
floor configuration parameter can be estimated without 
grasping the absolute height of each ground contact 
5 portion. This permits easier floor configuration 
estimation processing . 

In this forty-second invention, when at least one of 
the child nodes of the aforesaid C-th node is likely to 
float, the aforesaid floor configuration estimating means 

10 preferably estimates the aforesaid floor configuration 

parameter that specifies the relative relationship among 
the heights of the ground contact surfaces of the 
aforesaid plurality of child nodes, while maintaining the 
relative height of the ground contact surface of that 

15 child node, which is likely to float, at a fixed value (a 
forty-third invention) . 

More specifically, if at least one of the child 
nodes of the aforesaid C-th node is likely to float, this 
means that the ground contact surface of that child node 

20 has left or is about to leave an actual floor surface, so 
that the height of the ground contact surface of that 
child node does not reflect the height of the actual floor 
surface. Hence, in such a situation, the twenty-second 
invention estimates the aforesaid floor configuration 

25 parameter that specifies the relative relationship among 
the heights of the ground contact surfaces of the 
aforesaid plurality of child nodes while retaining the 
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relative height of the ground contact surface of the child 
node, which is about to float, at a fixed value. This 
makes it possible to prevent a floor configuration 
parameter from diverting to a value that does not reflect 
5 an actual floor surface configuration and makes it 

possible to estimate a floor configuration parameter that 
reflects an actual floor surface configuration. This 
consequently makes it possible to prevent the relative 
heights of ground contact portions from being corrected by 
10 using inappropriate floor configuration parameters, 

causing the stability of a posture of a mobile body to be 
impaired. 

Further, in the aforesaid thirty-eighth invention 
(or the thirty-eighth to the forty-third inventions) , the 

15 aforesaid floor configuration estimating means preferably 
estimates the aforesaid floor configuration parameter by 
using a low-pass filter so as to alleviate fluctuations in 
the floor configuration parameter (a forty-fourth 
invention) . Using a low-pass filter as described above 

20 makes it possible to prevent a floor configuration 

parameter from frequently changing due to vibrations or 
the like when a mobile body travels. 

Further, in the aforesaid thirty-eighth invention 
(or the thirty-eighth to the forty-fourth inventions) , a 

25 weight has been set on each node in the aforesaid tree 
structure, and 

if processing in which, when a predetermined type of 
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state amount, such as a height or a floor reaction force, 
is associated with each leaf node in the aforesaid tree 
structure, the state amount of each node having child 
nodes takes a weighted mean value, which uses the 
5 aforesaid weight, of the state amounts of all child nodes 
of the node, a value obtained by subtracting a state 
amount of a parent node of each node from the state amount 
of the node is determined as a node relative state amount 
of the node on each node except a root node, and zero is 

10 determined as a relative state amount of the root node, is 
defined as the processing for hierarchically relativizing 
the predetermined type of state amount on each node, 

if a node relative floor reaction force 
Fn_rel (n=l, 2, ...) hierarchically relativized on each node 

15 is determined on the basis of a floor reaction force 

Fn (n=l, 2, ...) acting on each of the ground contact portions, 
which are the aforesaid leaf nodes, and if a vector 
(Fal_rel, Fa2_rel, Far_rel) having, as its elements, the 
node relative floor reaction forces of all child nodes aj 

20 ( j =1 , 2 , . .. , r . r denotes the total number of the child nodes 

of an n-th node) of an n-th node, which is an arbitrary 
node having child nodes, is represented by a linear 
linkage of a plurality of predetermined mutually 
independent vectors R(j) ( j=l, 2, r-1) that are all 

25 orthogonal to a vector (Wal , Wa2 , . .. , War ) having the weights 
of all child nodes of the n-th node as its elements, then 
a vector having a coefficient of the linear linkage as its 
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element is defined as a node expansion floor reaction 
force moment Mn_exp of the n-th node, and 

if a node relative height Zn_rel (n=l , 2 , . . . ) 
hierarchically relativized on each node is determined on 
5 the basis of a height Zn (n=l, 2, ...) of the ground contact 
surface of each of the ground contact portions, which are 
the aforesaid leaf nodes, and if a vector (Zal_rel, 
Za2_rel, Zar_rel) having the node relative heights of 
all child nodes aj ( j =1 , 2 , . . . , r . r denotes the total number 

10 of the child nodes of an n-th node) of the aforesaid n-th 

node as its elements is expressed by a linear linkage of 
the plurality of the aforesaid predetermined mutually 
independent vectors R(j) ( j=l, 2, r-1) , then a vector 
having a coefficient of the linear linkage as its element 

15 is defined as a node expansion inclination angle 0n of the 
n-th node, and 

the floor configuration estimating means may 
estimate the aforesaid floor configuration parameter by 
using the aforesaid node expansion floor reaction force 

20 moment Mn_exp (n=C) or the node expansion inclination angle 
0n(n=C) of at least the aforesaid C-th node (a forty-fifth 
invention) . 

In this forty-fifth invention, relative to a B-th 
node, which is each node in the aforesaid tree structure, 
25 if the B-th node is the aforesaid leaf node, then the 

height of the ground contact surface of the ground contact 
portion that is the leaf node is defined as the height of 
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the ground contact surface of the B-th node, and if the B- 
th node has child nodes, then a weighted mean value, which 
uses the aforesaid weight, of the heights of the ground 
contact surfaces of all child nodes of the B-th node, is 
5 defined as the height of the ground contact surface of the 
B-th node, and 

the aforesaid floor configuration parameter 
preferably includes a parameter that uses the aforesaid 
node expansion inclination angle to indicate the relative 

10 height of the ground contact surface of each child node of 
the aforesaid C-th node (a forty-sixth invention) . 

With this arrangement, a floor configuration 
parameter can be properly estimated by using the aforesaid 
node expansion inclination angle even if there are four or 

15 more ground contact portions belonging to the C-th node. 

Further, the aforesaid forty-fifth invention 
preferably comprises a means for determining a desired 
floor reaction force that should act on each ground 
contact portion belonging to at least the aforesaid C-th 

20 node on the basis of at least the desired floor reaction 
force of the aforesaid desired gait, 

wherein the aforesaid node operation controlling 
means comprises a means for determining a desired node 
expansion moment, which is a desired value of the 

25 aforesaid node expansion moment of the C-th node, on the 
basis of the desired floor reaction force of each ground 
contact portion belonging to the aforesaid C-th node, a 



means for determining an actual node expansion moment, 
which is the actual value of the aforesaid node expansion 
moment of the C-th node on the basis of the actual floor 
reaction force of each ground contact portion belonging to 
the aforesaid C-th node, and a means for determining a 
manipulated variable of the aforesaid node expansion 
inclination angle of the aforesaid C-th node on the basis 
of the aforesaid actual node expansion moment and the 
aforesaid desired node expansion moment, and determines 
the aforesaid corrected desired motion by adding, to the 
aforesaid desired motion, a first correction of the 
desired relative heights of a plurality of ground contact 
portions belonging to the aforesaid C-th node on the basis 
of the aforesaid determined manipulated variable of the 
node expansion inclination angle (a forty-seventh 
invention) . 

With this arrangement, even if there are four or 
more ground contact portions belonging to a C-th node, a 
floor configuration parameter can be estimated while 
properly controlling a floor reaction force by using a 
node expansion inclination angle and a node expansion 
moment . 

Incidentally, in the first to the forty-seventh 
inventions described above, "floor reaction force'' is to 
include a reaction force received from an object other 
than a floor with which a mobile body comes in contact 
rather than simply meaning a reaction force acting on the 
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mobile body from a floor (or the ground) , as in its 
original meaning. Further, the ground contact portion is 
to include not only a portion that comes in contact with a 
floor (or the ground) but also a portion of the mobile 
5 body that comes in contact with an object. 

Brief Description of the Drawings 

Fig. 1 is an overall external view of a robot in 
accordance with a first embodiment and a second embodiment 

10 of the present invention, Fig. 2 is a block diagram 

showing the functional construction of a control device of 
the first embodiment, Figs. 3(a) to (c) and Figs. 4(a) to 
(c) are diagrams for explaining an operation of the robot 
(four-legged robot) of the first embodiment, Figs. 5(a) to 

15 (c) are graphs showing weight setting examples in the 

first embodiment, and Fig. 5(d) is a graph showing a 
setting example of a ZMP (desired total floor reaction 
force central point) in the first embodiment. Fig. 6 is a 
diagram showing the hierarchical structure of nodes in the 

20 first embodiment, Fig. 7 is a diagram showing a 

relationship between desired node floor reaction force 
central points and weights, Fig. 8 is a diagram showing a 
relationship between desired node floor reaction forces 
and weights, and Fig. 9 is a flowchart showing a main 

25 routine processing of the control device of the first 

embodiment. Fig. 10 to Fig. 14 are diagrams illustrating 
desired node floor reaction force translational force 



- 65 - 



components, actual node floor reaction force translational 
force components, actual node floor reaction force moments, 
compensating total floor reaction force moments, and node 
compensating floor reaction force moments, respectively, 
of a robot (four-legged robot) of the first embodiment. 
Fig. 15 and Fig. 16 are diagrams for explaining position 
corrections by node compensating angles (compliance 
operation) in the first embodiment, Fig. 17 to Fig. 21 are 
block diagrams respectively showing the functional 
constructions of a hierarchical compliance operation 
determiner, a compensating total floor reaction force 
moment distributor, a 0 1423 determiner (compensating 
angle determiner) , a 8 14 determiner (compensating angle 
determiner) , and a mechanism deformation compensation 
amount calculator in the first embodiment, Fig. 22 is a 
flowchart showing the processing for determining 
compensating angles, and Fig. 23 is a diagram for 
explaining another example of a hierarchical structure 
related to the robot according to the first embodiment. 
Fig. 24 is a diagram for explaining the hierarchical 
structure of a robot (six-legged robot) of a second 
embodiment, Fig. 25 is a block diagram showing the 
functional construction of a hierarchical compliance 
operation determiner in the second embodiment, Fig. 26 to 
Fig. 28 are diagrams respectively illustrating the 
translational force components of desired node floor 
reaction forces, the translational force components of 
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actual node floor reaction forces, and actual node floor 
reaction force moments of the robot (six-legged robot) of 
the second embodiment, Figs. 29(a) and (b) are diagrams 
for explaining the technique for setting a node 
5 compensating floor reaction force moment in the second 
embodiment, and Fig. 30 and Fig. 31 are diagrams for 
explaining a position correction based on node 
compensating angles (compliance operation) in the second 
embodiment. Fig. 32 and Fig. 33 are block diagrams 

10 respectively showing the functions of a 6 145236 

determiner (compensating angle determiner) and a 0 145 
determiner (compensating angle determiner) in the second 
embodiment, and Fig. 34 is a diagram for explaining 
another example of a hierarchical structure related to the 

15 robot of the second embodiment. Fig. 35 is a block 
diagram showing the functional construction of a 
hierarchical compliance operation determiner in a third 
embodiment, Fig. 36 is a flowchart showing a main routine 
processing of a control device in the third embodiment, 

20 Fig. 37 to Fig. 39 are diagrams for explaining concepts 
and terms in the third embodiment, Fig. 40 is a block 
diagram showing the function of a floor configuration 
estimator in the third embodiment, and Fig. 41 is a 
flowchart showing the processing of a floor height error 

25 estimation processing subroutine in Fig. 40. Fig. 42 and 
Fig. 43 are diagrams for explaining the processing for 
hierarchical relativi zat ion in a four-legged robot and a 
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six-legged robot, respectively. Fig. 44 is a diagram 
showing examples of setting request modes of nodes related 
to estimation of a floor configuration, and Fig. 45 to Fig. 
55 are flowcharts showing the processing for estimating a 
5 floor configuration. Fig. 56 is a block diagram showing 

the functions of a floor configuration estimator in a 
fourth embodiment, and Fig. 57 is a block diagram showing 
the functions of a floor configuration estimator in a 
fifth embodiment. Fig. 58 and Fig. 59 are diagrams 

10 showing a state wherein a robot (two-legged mobile robot) 

in a sixth embodiment is kneeling, Fig. 60 is a diagram 
showing the construction of a floor reaction force sensor 
of a knee of the robot in the sixth embodiment, Fig. 61 is 
a diagram showing a hierarchical structure of nodes in the 

15 sixth embodiment, and Fig. 62 is a block diagram showing 

the functional construction of a hierarchical compliance 
operation determiner in the sixth embodiment. Figs. 63(a) 
to (c) are diagrams for explaining a technique for 
correcting the posture of the body of the robot in the 

20 sixth embodiment, Fig. 64 is a diagram for explaining a 

technique for correcting the position/posture of the body 
of the robot in the sixth embodiment, and Fig. 65 is a 
block diagram showing the functions of an inverse 
kinematics calculator in the sixth embodiment. Fig. 66 is 

25 a block diagram showing the functions of an inverse 

kinematics calculator in a seventh embodiment, and Fig. 67 
and Fig. 68 are diagrams for explaining a technique for 
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correcting the posture of a robot in the seventh 
embodiment. Fig. 69 is a diagram showing the construction 
of a robot in an eighth embodiment and Fig. 70 is a 
diagram showing a hierarchical structure of nodes in the 
5 eighth embodiment. 

Best Mode for Carrying Out the Invention 

First, major terms to be used in the explanation of 
the embodiments of the present invention will be explained. 

10 In the technology of the composite-compliance 

control disclosed in Japanese Unexamined Patent 
Application Publication No. H10-277969 previously proposed 
by the present applicant, floor reaction forces are sorted 
for each leg on the assumption that floor reaction forces 

15 are received at the distal portion (foot) of a leg of a 
robot. In comparison therewith, according to the 
embodiments of the present description, situations are 
also considered in which floor reaction forces are 
received at portions other than the distal portions of 

20 legs, e.g., a situation in which a human type robot is 
kneeling, sitting on a chair, or has its arm in contact 
with the ground. For this reason, a portion of a legged 
mobile robot that comes in contact with a floor and 
receives a reaction force in a predetermined operation of 

25 the robot is referred to as "the ground contact portion." 

In this case, "floor" does not simply refer to a floor (or 
the ground) in a conventional sense, but "floor" also 
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includes an object with which the robot comes in contact 
and receives a reaction force during its movement, such as 
a chair (a chair on which the robot sits) fixed to the 
floor (or the ground) . Thus, if, for example, a two- 
5 legged mobile robot sits on a chair or the like, then the 

waist of the robot will correspond to the ground contact 
portion. In a normal travel of a legged mobile robot (in 
the walking or the like of the two-legged mobile robot) , 
the distal portion (foot or the like) of each leg will of 

10 course correspond to the ground contact portion. 

To categorize (discriminate) ground contact portions, 
even if ground contact portions are distributed such that 
they are separated at a plurality of locations on the same 
link (a part corresponding to a single rigid body) (if a 

15 plurality of portions separated from each other on the 

same link is in contact with the ground) , that is, even if 
a plurality of ground contact surfaces is not connected on 
the same link, these will be put together and defined as 
one ground contact portion. For instance, if the ground 

20 contact portion provided with four spike pins comes in 

contact with the ground through the intermediary of the 
spike pins, then the individual ground contact surfaces of 
the four spike pins will be put together and regarded as 
one ground contact portion. However, it is not always 

25 required to put the ground contact surfaces together into 
one . 

An n-th ground contact portion is a designation for 
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identifying the ground contact portion which has been 
classified (discriminated) according to such a rule and to 
which an identification number n (n=l, 2, 3, ...) has been 
assigned. 

5 A ground contact portion floor reaction force refers 

to a floor reaction force acting on the ground contact 
portion, and the floor reaction force acting on an n-th 
ground contact portion, in particular, is referred to as 
the n-th ground contact portion floor reaction force. The 

10 total floor reaction force is the resultant force of the 

floor reaction forces acting on all ground contact 
portions. The floor reaction force central point is the 
point of action at which the horizontal component of a 
moment generated by a floor reaction force at that point 

15 is zero. 

A floor reaction force, such as the ground contact 
portion floor reaction force or a total floor reaction 
force, is usually expressed by a set of the point of 
action of a force and a translat ional force and moment 

20 applied to that point of action. For the same floor 

reaction force, there are a limitless number of sets of 
point of action, translational force and moment for 
expressing the floor reaction force. Among them, there is 
an expression of a floor reaction force that uses, as the 

25 point of action, a point at which a moment component (the 
horizontal component of a moment) except a component about 
a vertical axis (vertical component) is zero. The point 



of action in this expression is referred to as a floor 
reaction force central point in the present description. 
A floor reaction force central point may be defined as a 
point at which the floor surface parallel component (the 
component parallel to a floor surface) of a moment 
generated by a floor reaction force at that point is zero 

In the present description, "floor surface" may 
alternatively be a virtual floor surface (a floor surface 
assumed in a desired gait and it does not necessarily 
coincide with an actual floor surface) described in 
Japanese Unexamined Patent Application Publication No. H5 
318340 previously proposed by the present applicant. 

Supplementally, the floor reaction force central 
point of the ground contact portion is usually set on the 
ground contact surface thereof (the surface in contact 
with a floor) if the ground contact portion is in contact 
with the ground. Meanwhile, the ground contact portion 
floor reaction force while the ground contact portion is 
moving in the air is always zero, so that a moment 
horizontal component of the ground contact portion floor 
reaction force will be zero at any point of action. This 
means that the floor reaction force central point can be 
arbitrarily set. However, to smoothly control the 
operation of a robot, a desired floor reaction force 
central point desirably moves in continuity. Hence, 
according to the embodiments in the present description, 
floor reaction force central point of the ground contact 



portion floor reaction force is defined as the point of 
action that moves together with the ground contact portion 
when the ground contact portion moves in the air. 

According to the embodiments in the present 
description, in the compliance control operation in which 
the position/posture of each ground contact portion are 
corrected on the basis of at least an actual floor 
reaction force (a floor reaction force actually acting on 
a robot) , the compliance control operation is not simply 
performed on each of ground contact portions irrelevantly 
(independently) from each other. The embodiments in the 
present description are characterized in that ground 
contact portion are sorted by a tree structure and 
operations for correcting the posit ions /postures of ground 
contact portions are determined on the basis of at least 
an actual floor reaction force acting on each group that 
has been sorted (the actual floor reaction forces or the 
resultant force thereof acting on all ground contact 
portions included in each group) . Hereinafter, 
classification by the tree structure may be referred to as 
"hierarchization . " 

For the desired values of variables generated by a 
gait generating device of a legged mobile robot in the 
embodiments in the present description, "desired" will be 
attached to the beginning of the names of variables. For 
the values of the variables in an actual legged mobile 
robot (actually detected values or estimated values, 
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because true values are unknown) , "actual" will be 
attached to the beginning of the names of variables. The 
above "actual floor reaction force" is an example thereof. 
The targets of the total floor reaction forces (the 
5 resultant force of the actual floor reaction forces acting 
on all ground contact portions of the robot) in the 
compliance control (floor reaction force control) to be 
discussed later will be referred to as desired total floor 
reaction forces. The point at which the moment horizontal 

10 component of a desired total floor reaction force is zero 

will be referred to as a desired total floor reaction 
force central point. 

The point on a floor surface at which the moment 
horizontal component of the resultant force of an inertial 

15 force generated by a motion of a desired gait of a mobile 
robot (the motion of each portion of the robot in a 
desired gait) and the gravity acting on the robot is zero 
will be referred to as a desired ZMP . The motion of a 
desired gait is determined by the time series of the 

20 desired position/posture of each portion of the robot in 
the desired gait, so that the time series of the desired 
position/posture of the portion will be generically 
referred to as a motion or a desired motion of a desired 
gait. Supplementally, if these time series can be 

25 specified, then desired motions may be described by 

expressions that are different from the desired motions 
defined as described above. For example, a set of the 



time series of the desired displacements of joints of a 
robot and the time series of the desired position/posture 
of a particular portion, such as a base body, may be used 
as a desired motion. 

A desired total floor reaction force is usually a 
total floor reaction force that dynamically balances with 
the motion pattern of a desired gait (the time-series 
pattern of a desired motion) . Hence, a desired total 
floor reaction force central point usually agrees with a 
desired ZMP. Thus, in the following explanation, a 
desired total floor reaction force central point and a 
desired ZMP will be used without discriminating them in 
many cases. Exceptionally, however, in the case of 
controlling a robot explained in, for example, Japanese 
Patent No. 3269852 previously proposed by the present 
applicant, a desired total floor reaction force central 
point and a desired ZMP do not necessarily agree with each 
other. In the following explanation, the term, desired 
ZMP, will be used in some cases, but there will be some 
places where the term, desired total floor reaction force 
central point, should be used to be precise. 

It may be assumed that, in a desired gait of a 
mobile robot, the robot is subject to a reaction force (an 
external force) other than a floor reaction force from an 
environment. And, the reaction force (the external force) 
other than a floor reaction force may be referred to as, 
for example, a desired object reaction force, and the 
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definition of a desired ZMP described above may be 
expanded as follows. The resultant force of the inertial 
force generated by a motion pattern of a desired gait of a 
robot, the gravity acting on the robot, and a desired 
5 object reaction force may be dynamically determined, and 
if the moment generated at a certain point on a floor 
surface by the resultant force is zero except for a 
component about a vertical axis, then the point may be 
defined anew as a desired ZMP. However, if a desired 
10 object reaction force is taken as one form of a floor 

reaction force, then the definition of a desired ZMP may 
be the same definition previously described. 

Based on the above, the embodiments of the present 
invention will be explained in detail below. 

15 

[First Embodiment ] 

Fig. 1 is an external view of a general multi-legged 
mobile robot (legged mobile robot) according to first and 
second embodiments. Fig. 1 shows that the robot 1 has six 

20 legs (leg bodies) , namely, a first leg #1 to a sixth leg 
#6; however, the robot in the first embodiment does not 
have the fifth leg #5 and the sixth leg #6. This means 
that, in the first embodiment, the robot 1 is a four- 
legged robot having four legs (leg bodies) , the first leg 

25 #1 to the fourth leg #4. In Fig. 1, the components of the 

robot 1 according to the second embodiment are shown by 
parenthesized reference numerals. 
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As shown in Fig. 1, in the robot 1 (the four-legged 
robot) according to the first embodiment, two legs (the 
first leg #1 and the third leg #3) are extended from the 
right side of a body 24, which is the base body of the 
5 robot 1, such that they are arranged side by side in the 
longitudinal direction, and in the same manner, two legs 
(the second leg #2 and the fourth leg #4) are extended 
from the left side of the body 24 such that they are 
arranged side by side in the longitudinal direction. A 

10 discoid ground contact portion 10 is attached to the 

distal portion of each of the legs #1 to #4 through the 
intermediary of a spherical joint 12, which is a free 
joint. Hereinafter, when the ground contact portions 10 
need to be discriminated among the legs #1 to #4, they 

15 will be referred to as the first ground contact portion, 
the second ground contact portion, the third ground 
contact portion, and the fourth ground contact portion. 

Each ground contact portion 10 is engaged with the 
spherical joint 12 such that its central point agrees with 

20 the central point of the spherical joint 12 and that a 
floor reaction force moment (the moment component of a 
floor reaction force) will not act on the central point of 
the ground contact portion 10 (strictly speaking, the 
spherical joint 12). This means that the floor reaction 

25 force moment (actual floor reaction force moment) at the 
central point of the ground contact portion 10 will be 
always zero. 



In the robot 1 shown in the figure, each of the legs 
#1 to #4 is provided with joints 14 and 15 at a portion 
adjacent to the body 24 of the robot 1 and at an 
intermediate portion, respectively, and a compliance 
mechanism 42 composed of an elastic member, such as a 
spring, and a six-axis force sensor 34 serving as a floor 
reaction force detecting means for detecting an actual 
floor reaction force acting on the ground contact portion 
10 are provided in the vicinity of the distal portion of 
each of the legs #1 to #4 (a portion of the link 
connecting the spherical joint 12 and the joint 14, the 
portion being adjacent to the spherical joint 12). In the 
example shown in the figure, the joints 14 permit rotation 
about two axes, while the joints 15 permit rotation about 
one axis. The bottom surfaces of the ground contact 
portions may be provided with elastic members made of 
sponge, rubber or the like serving as compliance 
mechanisms . 

The displacement operation (the rotational operation 
about each axis) of each of the joints 14 and 15 is 
performed by an actuator, such as an electric motor, which 
is not shown. And, an actual joint displacement, which is 
the actual displacement amount (the angle of rotation 
about each axis), of each of the joints 14 and 15 is 
detected by a sensor, such as a rotary encoder, which is 
not shown. The six-axis force sensor 34 is capable of 
detecting the translational forces in the directions of 
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three axes and the moments about three axes; however, in 
the robot 1 in the first embodiment, no actual floor 
reaction force moment acts on the central points of the 
ground contact portions 10, as described above. Hence, 
5 three-axis force sensors that detect the translational 
forces in the directions of three axes or force sensors 
that detect only the vertical components of the 
translational forces of actual floor reaction forces may 
be used in place of the six-axis force sensors 34. 

10 The body 24 incorporates a control device 50 

constructed of an electronic circuit unit that includes a 
microcomputer, an actuator drive circuit, etc., a posture 
sensor 36 for detecting the postures of the body 24, and a 
power source not shown (a secondary battery, a capacitor, 

15 or the like) . The posture sensor 36 is constructed of, 

for example, an acceleration sensor and a gyro sensor. In 
the present description, "posture" generally means a 
spatial orientation (however, "the posture" of the entire 
robot means an instantaneous value of a motion of the 

20 robot) . Further, in the present embodiment, the posture 
sensor 36 detects the posture inclinations (inclination 
angles) of the postures of the body 24 in, for example, 
the pitch directions and roll directions in relation to 
the vertical direction. This means that the posture 

25 sensor 36 functions as an actual posture inclination 

detecting means for detecting actual posture inclinations 
of the body 24. 
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If the postures (rotational angles) of the body 24 
of the robot 1 in the yaw direction are to be also 
controlled, then the rotational angles of the body 24 in 
the yaw direction (in other words, the postures of the 
5 body 24 in the directions of three axes) may be also 
detected by the posture sensor 36. 

Fig. 2 is a block diagram showing the functional 
construction and operations of the control device 50. The 
actual robot 1 shown in Fig. 2 is the robot 1 shown in Fig. 

10 1 from which the control device 50, the posture sensor 36, 

and the six-axis force sensor 34 have been removed. Here, 
a predetermined coordinate system (XYZ coordinate system) 
fixed to a floor, in which the approximately front 
direction of the robot 1 is defined as X axis, 

15 approximately left side direction thereof is defined as Y 
axis, and the upward direction thereof is defined as Z 
axis, as shown in Fig. 1, is referred to as "a supporting 
leg coordinate system" or "a global coordinate system." 
Hereinafter, positions, postures, translational forces and 

20 moments will be expressed in terms of coordinate 

components of the supporting leg coordinate system (the 
global coordinate system) unless otherwise specified. The 
origin of the supporting leg coordinate system (global 
coordinate system) does not have to be steadily fixed at a 

25 single point; the position of the origin with respect to a 

floor may be changed while the robot 1 is traveling. For 
example, the position of the origin of the supporting leg 



- 80 - 



coordinate system (the global coordinate system) may be 
changed each time a predetermined leg of the robot 1 lands. 

As shown in Fig. 2, the control device 50 is 
provided with a gait generating device 100, a desired 
5 floor reaction force distributor 102, a robot geometric 

model (inverse kinematics calculator) 110, a hierarchical 
compliance operation determiner 114, a displacement 
controller 112, an actual floor reaction force detector 
108, a posture error calculator 103, and a posture 

10 stabilization control calculator 104 as its functional 

components (functional means) . The following will explain 
the overviews of the components of the control device 50. 

The gait generating device 100 has a function as a 
desired gait determining means or a desired motion 

15 determining means in the present invention, and generates 
(determines) and outputs a desired gait that specifies an 
operation of the robot 1. In the present embodiment, a 
desired gait is formed of the trajectory of a desired 
motion of the robot (the time series of a desired 

20 position/posture of each portion of the robot) and the 
trajectory of a desired floor reaction force (the time 
series of a set of the desired position of the action 
point of a reaction force received by the robot from a 
floor and the desired values of a translational force and 

25 moment applied to the action point) . In the present 
description, "trajectory" means a time-series pattern 
(temporal change pattern) . 



The trajectory of a desired motion output by the 
gait generating device 100 is constructed of a desired 
ground contact portion trajectory, which is the trajectory 
of the desired values of the position and the posture of 
each ground contact portion 10 of the robot 1, and a 
desired body position/posture trajectory, which is the 
trajectory of the desired values of the position and the 
posture of the body 24 of the robot 1. A gait generating 
device in a robot equipped with joints related to arms or 
a head, as in a sixth embodiment to be discussed later, 
determines and outputs the desired position/posture 
trajectories of the arms or the head as constituents of 
desired motions. 

Further, in the present embodiment, the trajectory 
of a desired floor reaction force output by the gait 
generating device 100 is formed of a desired total floor 
reaction force central point trajectory, which is the 
trajectory of a desired position of the total floor 
reaction force central point of the robot 1, and a desired 
total floor reaction force trajectory, which is the 
trajectory of a desired value of a total floor reaction 
force that uses the above desired total floor reaction 
force central point as an action point. In the present 
embodiment, a desired total floor reaction force central 
point trajectory is regarded as identical to a desired ZMP 
trajectory, which is the trajectory of a desired position 
of ZMP. 
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The position of each ground contact portion 10 is 
the position of a certain representative point of the 
ground contact portion 10, and the representative point is, 
for example, the projected point obtained by projecting, 
5 in the vertical direction, the central point of each 

ground contact portion 10 (the central point of the 
spherical joint 12) onto the ground contact surface 
(bottom surface) of the ground contact portion 10, or the 
central point of the ground contact portion 10 (the 

10 central point of the spherical joint 12). Hereinafter, 

the position of the representative point of each ground 
contact portion 10 will be referred to simply as the 
ground contact portion position. The trajectory of a 
desired value of the ground contact portion position (a 

15 desired ground contact portion position trajectory) is 

included in the aforesaid desired ground contact portion 
trajectory determined by the gait generating device 100. 

Here, in the robot 1 of the present embodiment, the 
ground contact portions 10 are engaged with the spherical 

20 joints 12, which are free joints, so that the postures of 
the ground contact portions 10 cannot be controlled. 
Therefore, according to the present embodiment, the gait 
generating device 100 does not actually generate the 
trajectories of desired postures of the ground contact 

25 portions 10 (does not have to generate them) . In the 

present embodiment, therefore, the desired ground contact 
portion trajectory means the same as a desired ground 
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contact portion position trajectory. 

However, if the ground contact portions are attached 
to the distal portions of the legs such that their 
postures can be controlled (if the ground contact portions 
5 are attached to the distal portions of the legs through 

joints that can be operated by actuators), as in the robot 
of the sixth embodiment to be discussed later, then the 
trajectories of desired postures of the ground contact 
portions should be included in the desired ground contact 

10 portion trajectories. In the present description, the 
term "ground contact portion position/posture'' will be 
frequently used to generally consider the aforesaid case, 
the term substantially meaning "ground contact portion 
position" in the present embodiment. 

15 Referring to Fig. 3(a) to Fig. 3(c) and Fig. 4(a) to 

Fig. 4(c), a desired ground contact portion trajectory (a 
desired ground contact portion position trajectory) and a 
desired total floor reaction force central point 
trajectory will be explained more specifically. According 

20 to the first embodiment, a travel of the robot 1 is 

accomplished by carrying out the motions of the legs #1 to 
#4 by causing a pair of legs, which are to be free legs, 
to leave a floor and move in the air and then land at 
desired positions by repeating, in order, a period during 

25 which the pair of the first leg #1 and the fourth leg #4 
out of the legs #1 to #4 is a pair of supporting leg, 
while the pair of the second leg #2 and the third leg #3 
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is a pair of free legs, a period during which all legs #1 
to #4 are supporting legs, and a period during which the 
pair of the first leg #1 and the fourth leg #4 is a pair 
of free legs, while the pair of the second leg #2 and the 
5 third leg #3 is a pair of supporting legs. A supporting 

leg is a leg that is in contact with the ground to support 
the self-weight of the robot 1 (a leg to be subject to a 
floor reaction force that is not zero) , and a free leg is 
a non-supporting leg. 

10 Fig. 3(a) to Fig. 3(c) and Fig. 4(a) to Fig. 4(c) 

show the desired ground contact portion positions (more 
specifically, the positions on a horizontal plane (XY 
plane) ) of the distal ends of the legs #1 to #4 during the 
aforesaid travel of the robot 1 in time series in sequence 

15 (in the sequence of time tl to t6) . The triangles 

corresponding to reference characters Ql to Q4 in these 
figures indicate the desired ground contact portion 
positions of the first to the fourth ground contact 
portions 10, respectively (the positions of the aforesaid 

20 representative points of the first to the fourth ground 
contact portions 10 on a horizontal plane (XY plane) ) . 

Supplementally, to be precise, the triangles with 
the reference characters Ql to Q4 in Fig. 3 and Fig. 4 
indicate the positions of desired node floor reaction 

25 force central points (desired ground contact portion floor 
reaction force central points) to be discussed later, 
which are related to the ground contact portions 10. In 
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the present embodiment, however, the representative points 
of the ground contact portions 10 are set as described 
above, so that the desired ground contact portion 
positions (the desired positions of the representative 
5 points) of the first to the fourth ground contact portions 
10 agree with the positions of the desired node floor 
reaction force central points Qn (n=l,2,3,4), which will 
be discussed later, or have a certain positional 
relationship with the positions of the respective desired 

10 node floor reaction force central points Qn (n=l,2,3,4) 

(the positions on the horizontal plane (XY plane) agree) . 
For this reason, the triangles corresponding to the 
reference characters Ql, Q2, Q3 and Q4 in Fig. 3 and Fig. 
4 denote the desired node floor reaction force central 

15 points, which will be discussed later, of the first to the 
fourth ground contact portions 10, respectively, and also 
denote the positions of the first to the fourth ground 
contact portions 10, respectively. 

Fig. 3(a) shows the desired ground contact portion 

20 positions of the ground contact portions 10 at the instant 
(time tl) when the pair of the first leg #1 and the fourth 
leg #4 as free legs is landed, the pair of the second leg 
#2 and the third leg #3 being supporting legs, Fig. 3(b) 
shows the desired ground contact portion positions at time 

25 t2 in a state wherein all the legs #1 to #4 are supporting 
legs, and Fig. 3(c) shows the desired ground contact 
portion positions at time t3 immediately before the pair 
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of the second leg #2 and the third leg #3 as free legs is 
separated from a floor (lifted into the air) , the pair of 
the first leg #1 and the fourth leg #4 being supporting 
legs. Further, Fig. 4(a) shows the desired ground contact 
5 portion positions at time t4 in a state wherein the pair 
of the second leg #2 and the third leg #3 as free legs is 
lifted into the air, the pair of the first leg #1 and the 
fourth leg #4 being supporting legs, Fig. 4(b) shows the 
desired ground contact portion positions at the instant 

10 (time t5) when the pair of the second leg #2 and the third 

leg #3 as free legs is landed, the pair of the first leg 
#1 and the fourth leg #4 being supporting legs, and Fig. 
4 (c) shows the desired ground contact portion positions at 
time t6 immediately before the pair of the first leg #1 

15 and the fourth leg #4 as free legs is separated from a 

floor, the pair of the second leg #2 and the third leg #3 
being supporting legs. Incidentally, in Fig. 4(a), the 
desired ground contact portion positions of the second leg 
#2 and the third leg #3, which are free legs, are 

20 indicated by dashed-line triangles. Supplementally, the 

trajectory of the positions of the ground contact portions 
10 of free legs in the vertical direction (the Z-axis 
direction) is determined such that they rise from a floor 
surface to a predetermined height and then lower to land 

25 again. 

Points P in these Fig. 3 and Fig. 4 indicate desired 
total floor reaction force central points (desired ZMPs) . 
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The desired total floor reaction force central point 
trajectories are determined such that they continuously 
move while existing in a range in which ZMPs may exist (a 
region on a floor surface corresponding to a so-called 
5 supporting polygon) at positions not excessively close to 

the boundaries of the range (e.g., at an approximately 
central position of the range wherein a ZMP may exist) . 
In the first embodiment, when two legs #1 and #4 or #2 and 
#3 are supporting legs (refer to Figs. 3(a) and (c) and 

10 Figs. 4(a) to (c) ) , a desired total floor reaction force 

central point is set on a segment connecting the 
representative points of the ground contact portions 10 
and 10 of those legs such that it is not excessively close 
to an end point of the segment. When all legs #1 to #4 

15 are supporting legs (refer to Fig. 3(b)), a desired total 
floor reaction force central point is set within a polygon 
having the representative points of all ground contact 
portions 10 as its apex angles such that it is not 
excessively close to a boundary of the polygon. Fig. 5(d) 

20 is a graph illustrating a trajectory of a component ZMPx 
in the X-axis direction (in the direction in which the 
robot 1 advances) of the position of the desired total 
floor reaction force central point (desired ZMP) 
determined as described above. Figs. 5(a) to (c) are 

25 graphs illustrating setting examples of weight, which will 
be discussed later. 

Further, a desired body position/posture trajectory 
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determined by the gait generating device 100 is determined 
using a dynamic model or the like of the robot 1 such that 
the horizontal component of a moment generated about a 
desired ZMP by the resultant force of the inertial force 
5 generated by a desired motion of the robot 1 and the 

gravity acting on the robot 1 becomes zero. Incidentally, 
"the body position" is the position of a certain 
representative point of the body 24. 

A desired total floor reaction force determined by 

10 the gait generating device 100 is constructed of the 

desired values of the translational force and the moment 
acting on a desired total floor reaction force central 
point, and it is determined such that it balances with the 
resultant force of the inertial force generated by a 

15 desired motion of the robot 1 and the gravity acting on 
the robot 1 at a desired total floor reaction force 
central point in the present embodiment. The moment 
horizontal component of the desired total floor reaction 
force about the desired total floor reaction force central 

20 point (desired ZMP) is zero. Supplementally, it is not 

necessary to determine all components of the translational 
force and the moment acting on the desired total floor 
reaction force central point as desired values. For 
instance, if the posture or the floor reaction force of 

25 the robot 1 about the vertical axis is not controlled, 

then it is not necessary to determine the component of the 
moment of the desired total floor reaction force about the 
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vertical axis (the component in the Z-axis direction) . 

The desired ground contact portion trajectory 
determined by the gait generating device 100 (the desired 
ground contact portion position trajectory) is corrected 
5 by a hierarchical compliance operation determiner 114, 
which will be discussed later. 

The desired floor reaction force distributor 102 
groups (that is, hierarchizes ) the first to the fourth 
ground contact portions 10 of the robot 1 into a tree 

10 structure, and associates the nodes of the tree structure 

with the hierarchized groups. Hence, in the following 
explanation, the nodes may be expressed by replacing them 
by the groups. Each node is a group constructed of one or 
more ground contact portions 10. 

15 In the first embodiment, the ground contact portions 

10 are hierarchized, as shown in Fig. 6. More 
specifically, the n-th ground contact portion 10 
(n=l,2,3,4) is associated with the n-th node, the node 
having a first node and a fourth node as child nodes is 

20 defined as a 14th node, the node having a second node and 
a third node as child nodes is defined as a 23rd node, and 
the node having the 14th node and the 23rd node as child 
nodes is defined as the 1423rd node. Thus, the first to 
the fourth nodes are nodes that are constructed of the 

25 first, the second, the third, and the fourth ground 

contact portions 10, respectively, the 14th node is a node 
constructed of the first ground contact portion 10 and the 
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fourth ground contact portion 10, the 23rd node is a node 
constructed of the second ground contact portion 10 and 
the third ground contact portion 10, and the 1423rd node 
is the node constructed of all the ground contact portions 
5 10 . 

According to general designations in a tree 
structure, a node having no child node is referred to as a 
leaf node, and a node having no parent node is referred to 
as a root node. Thus, the n-th node (n=l,2,3,4) is a leaf 

10 node, while the 1423rd node is a root node. In the 

present description, to identify nodes, leaf nodes will be 
assigned the same numbers (1,2,3,...) as those of the 
ground contact portions (or legs) associated therewith, 
while nodes other than the leaf nodes will be assigned 

15 with numbers that are greater than those of the leaf nodes. 
Further, the nodes other than the leaf nodes and the root 
node will be referred to as intermediate nodes. In the 
first embodiment, the intermediate nodes are the 14th node 
and the 23rd node. 

20 The desired floor reaction force distributor 102 

corresponds to a desired node floor reaction force 
distributing means in the present invention, and the 
desired floor reaction force distributor 102 receives a 
desired total floor reaction force central point 

25 trajectory, a desired total floor reaction force 

trajectory and a desired ground contact portion trajectory 
out of a desired gait determined by the gait generating 
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device 100. The gait parameters (the estimated landing 
position, an estimated landing time, etc. of the ground 
contact portion 10 of a free leg of the robot 1) used by 
the gait generating device 100 to determine the desired 
5 gait may be also input to the desired floor reaction force 
distributor 102. Then, on the basis of these inputs, the 
desired floor reaction force distributor 102 determines 
desired node floor reaction force central points (desired 
n-th node floor reaction force central points) Qn 

10 (n=l, 2, 3, 4, 14, 23, 1423) , which are the desired positions of 

the floor reaction force central points of the nodes 
hierarchized as described above, and weights Wn 
(n=l, 2, 3, 4, 14, 23) of the nodes except the root node. Each 
weight Wn will take a nonnegative value of 1 or less. 

15 The technique for determining desired node floor 

reaction force central points Qn (n=l, 2, 3, 4, 14, 23) and the 
weights Wn ( n=l , 2 , 3 , 4 , 1 4 , 2 3 ) will be explained in detail 
below with reference mainly to Fig. 3(b), Fig. 5 and Fig. 
7. Fig. 3(b) shows a relationship between Qn and Wn in a 

20 state illustrated in the figure, Figs. 5(a) to (c) show 
setting examples of Wn, and Fig. 7 shows a relationship 
between weights and desired node floor reaction force 
central points. 

The desired node floor reaction force central point 

25 of the 1423rd node, which is the root node, (the desired 
1423rd node floor reaction force central point) Q1423 is 
determined to be identical to the desired total floor 
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reaction force central point (point P in Fig. 3 and Fig 
4) (P=Q1423) . Accordingly, in the following explanation, 
the same reference character P as that of a desired total 
floor reaction force central point will be frequently used 
as the mark denoting the desired 1423rd node floor 
reaction force central point. 

Further, a weight W1423 of the root node is set to 
"1" for the sake of convenience in order to maintain the 
uniformity of expressions. 

In the present embodiment, the desired floor 
reaction force central point of an n-th ground contact 
portion 10 (n=l,2,3,4) (also referred to as a desired n-th 
ground contact portion floor reaction force central point) 
is always set to the central point of an n-th ground 
contact portion 10 (the central point of the spherical 
joint 12). Further, the desired node floor reaction force 
central point Qn (n=l,2,3,4) of a leaf node associated 
with the n-th ground contact portion 10 is determined to 
be identical to the desired floor reaction force central 
point of the n-th ground contact portion 10. Hence, the 
desired node floor reaction force central point Qn 
(n=l,2,3,4) is also always set to the central point of the 
n-th ground contact portion 10 (the position of this point 
is uniquely determined from a desired ground contact 
portion position of the n-th ground contact portion 10). 
The position of the desired node floor reaction force 
central point Qn (n=l,2,3,4) of the leaf node determined 
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as described above is uniquely determined from the desired 
ground contact portion position of the n-th ground contact 
portion 10. In other words, the desired node floor 
reaction force central point Qn (n=l,2,3,4) of a leaf node 
5 defines the desired position of the n-th ground contact 
portion 10. In the following explanation, the desired 
node floor reaction force central point of a leaf node may 
be referred to as a desired ground contact portion floor 
reaction force central point in some cases. Each desired 

10 ground contact portion trajectory is set such that it 
continuously changes, so that Qn (n=l,2,3,4) will also 
continuously change . 

Supplementally, in the present embodiment, the 
desired floor reaction force central point Qn (n=l,2,3,4) 

15 of an n-th leaf node (an n-th ground contact portion 10) 
has been set to the central point of the n-th ground 
contact portion 10; however, in a robot that allows the 
postures of ground contact portions to be controlled, the 
desired floor reaction force central point of each leaf 

20 node (each ground contact portion) may be set, for example, 
within the ground contact surface of the ground contact 
portion defined by the desired position/posture of the 
ground contact portion associated with the leaf node (the 
surface that comes in contact with a floor surface assumed 

25 in a desired gait) . 

Hereinafter, in general, a segment that connects 
arbitrary two points A and B or the length thereof will be 
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denoted as AB . In addition, an operator means 
multiplication for a pair of scalar and scalar or a pair 
of scalar and vector, while it means an outer product 
(vector product) for a pair of vector and vector. 
5 The weight Wn (n=l, 2, 3, 4, 14, 23) of each node except 

the root node and desired node floor reaction force 
central points Q14 and Q23 of the intermediate nodes are 
determined such that a desired 14th node floor reaction 
force central point Q14 will be the internally dividing 

10 point of a segment Q1Q4 that satisfies a relational 

expression, Q1Q14 :Q14Q4=W4 :W1= (1-W1) :W1, a desired 23rd 
node floor reaction force central point Q23 will be the 
internally dividing point of a segment Q2Q3 that satisfies 
a relational expression, Q2Q2 3 : Q2 3Q3=W3 : W2= ( 1 -W2 ) : W2 , and 

15 a desired 1423rd node floor reaction force central point P 
(= desired total floor reaction force central point) will 
be the internally dividing point of a segment Q14Q23 that 
satisfies Ql 4 P : PQ2 3=W2 3 : Wl 4= ( 1 -Wl 4 ) :W14. 

In other words, Q14, Q23 and Wn (n=l, 2, 3, 4, 14, 23) 

20 are determined to satisfy at least the following 
expressions 1, 2 and 3. Incidentally, Qn 

(n=l, 2, 3, 4, 14, 23) in these expressions 1 to 3 means the 
position (positional vector) of the point. 

25 Q14=Q1*W1+Q4*W4 , Wl+W4 = l . . . Expression 1 

Q23=Q2*W2+Q3*W3 , W2+W3 = l . . . Expression 2 

P=Q14*W14+Q23*W23 , W14+W23 = l . . . Expression 3 
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Wn (n=l, 2, 3, 4, 14, 23) takes a nonnegative value of 1 
or less, so that the coefficients (weights) of Qn 
(11=1,2,3,4,14,23) in the right sides of the above 
5 expressions 1, 2 and 3 will be all nonnegative values. 

The above expressions 1 to 3 mean that the position 
of a desired node floor reaction force central point of 
each node having child nodes (that is, each node that is 
not a leaf node) is set to a weighted average position of 

10 the positions of the desired node floor reaction force 

central points of the child nodes of the node by using a 
predetermined nonnegative weight. In other words, as 
shown in Fig. 3(b) and Fig. 7 mentioned above, the desired 
floor node reaction force central point Qn (n=14, 23, 1423) 

15 of each node having child nodes is set at the internally 
dividing point of the desired node floor reaction force 
central points of all the child nodes of the node. Fig. 7 
is a diagram showing a relationship between the desired 
node floor reaction force central points Qn 

20 (n=l, 2, 3, 4, 14, 23, 1423) of nodes and the weights Wn 

(n=l, 2, 3, 4, 14, 23) . Incidentally, L23, L14 and L1423 in 
Fig. 3(b) denote segments Q2Q3, Q1Q4 and Q23Q14, 
respectively . 

Supplementally, Ql to Q4 and P (=Q1423) are 

25 determined as described above, so that once Wn 

(n=l, 2, 3, 4, 14, 23) is determined, Q14 and Q23 that satisfy 
expressions 1 to 3 are uniquely determined. In other 
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words, if Q14 and Q23 are determined, then Wn 
(n=l, 2, 3, 4, 14, 23) satisfying expressions 1 to 3 will be 
uniquely determined. Accordingly, the weights Wn 
(n=l, 2, 3, 4, 14, 23) may be determined and then the desired 
5 node floor reaction force central points Q14 and Q23 of 

intermediate nodes according to the above expressions 1 to 
3 may be determined, or the desired node floor reaction 
force central points Q14 and Q23 of the intermediate nodes 
may be determined and then the weights Wn 

10 (n=l, 2, 3, 4, 14, 23) may be determined according to the above 

expression 1 to 3. Either way may be used. 

The desired node floor reaction force central points 
Q14 and Q23 of the intermediate nodes move as the ground 
contact portions 10 move, as shown in time series in Fig. 

15 3(a) to Fig. 3(c) and Fig. 4(a) to Fig. 4(c). Weights W14 

(=1-W23) , Wl (=1-W4) and W3 (=1-W2) at this time are 
determined such that they continuously change, as shown in, 
for example, the graphs of Figs. 5(a) to (c) , respectively. 
The trajectory of Qn and the weight Wn of the n-th node 

20 (n=l,2,3,4) are set such that they continuously change, so 

that the desired node floor reaction force central points 
Q14 and Q23 are also set such that they continuously move. 
This means that all desired node floor reaction force 
central points (desired n-th node floor reaction force 

25 central points (n=l, 2, 3, 4, 14, 23, 1423) ) are set such that 
they continuously move. 

The desired floor reaction force distributor 102 
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outputs the desired node floor reaction force central 
point of each node determined as described above. The 
desired floor reaction force central point of the root 
node is the same as the desired total floor reaction force 
5 central point determined by the gait generating device 100, 
so that it does not have to be output from the desired 
floor reaction force distributor 102. 

The desired floor reaction force distributor 102 
determines and outputs a desired node floor reaction force, 

10 which is the desired value of the floor reaction force 

acting on the desired floor reaction force central point 
of each node. The desired node floor reaction force that 
is output includes at least a desired node floor reaction 
force (a desired n-th node floor reaction force) acting on 

15 a desired node floor reaction force central point Qn of an 
n-th node (n=l,2,3,4), which is a leaf node, that is, the 
desired floor reaction force of each ground contact 
portion 10. This desired node floor reaction force is 
necessary primarily to compensate for the flexures of the 

20 compliance mechanisms 42 or the like (refer to Fig. 1) of 
the legs #1 to #4 (more specifically, compensation for the 
positional displacement of the ground contact portions 10 
caused by the flexures of the compliance mechanisms 42 and 
the link mechanisms of the legs) , the compensation being 

25 carried out by the processing of a hierarchical compliance 
operation determiner 114, which will be discussed later. 
Supplementally, if the robot 1 is provided with compliance 
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mechanisms in addition to those on the distal portions of 
the legs #1 to #4, then preferably, a desired 14th node 
floor reaction force and a desired 23rd node floor 
reaction force (the desired node floor reaction forces of 
5 intermediate nodes) are also determined and output in 

order to determine the deformations of the compliance 
mechanisms . 

Generally, a desired floor reaction force (a desired 
node floor reaction force) acting on a desired node floor 

10 reaction force central point of each node may be 

determined from a desired total floor reaction force and 
the weight of each node. Specifically, the desired floor 
reaction force of any one node may be determined by 
multiplying the product of the weight of the node and the 

15 weight of all ancestor nodes of the node by a desired 

total floor reaction force. More specifically, a desired 
n-th node floor reaction force is calculated according to 
the following expression 4a (or expression 4b) . 



20 Desired n-th node floor reaction force 
= Weight of the n-th node 

* Product of the weights of all ancestor nodes of the 
n-th node 

* Desired total floor reaction force ... Expression 4a 
25 Desired n-th node floor reaction force 

= Weight of the n-th node 

* Product of the weight of all ancestor nodes 
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(excluding the root node) of the n-th node 

* Desired total floor reaction force ... Expression 4b 



Alternatively, desired node floor reaction forces 
5 are determined such that the desired floor reaction force 
of an arbitrary n-th node that is not a leaf node agrees 
with the sum (resultant force) of the desired floor 
reaction forces of all child nodes of the n-th node and 
the desired floor reaction force of the root node agrees 

10 with a desired total floor reaction force. This 
relationship is shown in Fig. 8. 

More specifically, if a desired n-th node floor 
reaction force, which is the desired floor reaction force 
of an n-th node, is denoted by Fn (n=l, 2, 3, 4, 14, 23, 1423) 

15 and a desired total floor reaction force is denoted by 
Ftotalref, then Fn is determined from Ftotalref and the 
weight Wn (n=l , 2 , 3, 4 , 14 , 23) according to the expressions 
shown in Fig. 8. The expressions in Fig. 8 are equivalent 
to the above expression 4a or 4b. 

20 Determining the desired floor reaction force central 

point of each node (a desired node floor reaction force 
central point) and the desired floor reaction force of 
each node (a desired node floor reaction force) as 
described above is to determine the desired floor reaction 

25 force central point and the desired floor reaction force 
of each node such that the horizontal component of the 
moment generated about a desired n-th node floor reaction 
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force central point by the resultant force of the desired 
floor reaction forces of all child nodes of an n-th node 
becomes zero. Accordingly, the moment horizontal 
component of a desired node floor reaction force is zero 
5 for any nodes. 

A set of each desired node floor reaction force 
central point Qn (n=l, 2, 3, 4, 14, 23) , each weight 
Wn (n=l, 2, 3, 4, 14, 23) and each desired node floor reaction 
force Fn (n=l, 2, 3, 4, 14, 23) is determined such that the 

10 desired floor reaction force of the ground contact portion 
10 not in contact with the ground (in a no-contact-with- 
ground state) (the desired node floor reaction force of a 
leaf node associated with the ground contact portion 10 
not in contact with the ground) is zero. Hence, in the 

15 first embodiment, the weight W14 is set to zero (W23=l) 

during a period in which the first ground contact portion 
10 and the fourth ground contact portion 10 are free legs 
and off a floor (the ground contact portions 10 of the 
free legs are moving in the air) , while the weight W23 is 

20 set to zero (W14=l) during a period in which the second 
ground contact portion 10 and the third ground contact 
portion 10 are free legs and off a floor, as shown in Fig. 
5(a) . Thus, the weight of an intermediate node having 
child nodes is set to zero during a period in which none 

25 of the ground contact portions belonging as leaf nodes to 
the intermediate node are in contact with the ground. In 
other words, the weight of an intermediate node is not set 
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to zero during a period in which any one of the ground 
contact portions belonging to the intermediate node is in 
contact with the ground (strictly speaking, a period 
during which a non-zero floor reaction force is acting on 
5 any one of the ground contact portions) . 

Supplementally, the first embodiment does not have a 
period during which only one of the first ground contact 
portion 10 and the fourth ground contact portion 10 
belonging to the intermediate node Q14 is placed in a no- 
lo contact-with-ground state; therefore, the weights Wl and 
W4 corresponding to these ground contact portions 10 and 
10 do not have any periods during which they are 0 or 1 . 
If, however, a desired ground contact portion trajectory 
is determined so as to include a period during which only 
15 one of the first ground contact portion 10 and the fourth 
ground contact portion 10 will be placed in the no- 
contact-with-ground state, then the weight associated with 
the ground contact portion 10 that will be placed in the 
no-contact-with-ground state during the period may be set 
20 to 0, and the weight associated with the ground contact 

portion 10 to be in contact with the ground may be set to 
1. In this case, the weight of the intermediate node Q14 
during that period will be set to a non-zero value. The 
same applies to the weights associated with the 
25 intermediate node Q23 and the second ground contact 

portion 10 and the third ground contact portion 10, which 
are leaf nodes belonging thereto. Generally speaking, the 
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weight of a node having child nodes is set to a non-zero 
value if any one of the ground contact portions belonging 
to the node is in contact with the ground, while it is set 
to zero if all of the ground contact portions belonging to 
5 the node are in the no-contact-with-ground state. 

The desired node floor reaction forces determined as 
described above continuously change, making them suited 
for achieving a movement (walking) of the robot 1 with 
less impact. 

10 As described above, according to the first 

embodiment, each desired node floor reaction force central 
point Qn (n=l , 2 , 3 , 4 , 1 4 , 2 3 , 1 4 2 3 ) , each weight 
Wn (n=l, 2, 3, 4, 14, 23) and each desired each floor reaction 
force Fn (n=l, 2, 3, 4, 14, 23, 1423) are determined by the 

15 desired floor reaction force distributor 102 such that 
they satisfy the following conditions A) to G) . 
A) The desired node floor reaction force central point 
Qn (n=l , 2 , 3 , 4 ) of each leaf node agrees with the central 
point of the ground contact portion 10 corresponding to 

20 the leaf node. More generally, Qn (n=l , 2 , 3 , 4 ) is 

determined according to a desired gait (a desired motion, 
such as a desired ground contact portion trajectory). 
Supplementally, for example, the desired floor reaction 
force central point of each ground contact portion 10 may 

25 be determined by the gait generating device 100, and in 
this case, the desired node floor reaction force central 
point Qn (n=l , 2 , 3 , 4 ) may be determined on the basis of the 
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desired floor reaction force determined by the gait 
generating device 100. 

B) The desired node floor reaction force central point of 
the root node agrees with a desired total floor reaction 

5 force central point P. 

C) The desired node floor reaction force central point 

Qn (n=l, 2, 3, 4, 14, 23) and the weight Wn (n=l , 2 , 3 , 4 , 1 4 , 2 3 ) of 
each node excluding the root node satisfy the relational 
expressions of the above expressions 1 to 3 . In other 
10 words, the desired node floor reaction force central point 
Qn of an arbitrary n-th node (n=14 , 23 , 1 423 ) having child 
nodes will be a weighted average point of the desired node 
floor reaction force central points of the child nodes of 
the n-th node. 

15 D) The desired node floor reaction force Fn of an 

arbitrary n-th node (n=14, 23, 1423) having child nodes 
agrees with the sum (resultant force) of the desired node 
floor reaction forces of all child nodes of the n-th node, 
and the desired node floor reaction force F1423 of the 

20 root node (the 1423rd node) agrees with the desired total 
floor reaction force Ftotalref . In other words, the 
desired floor reaction force Fn and the weight Wn of the 
n-th node (n=l, 2, 3, 4, 14, 23, 1423) satisfy the relational 
expressions in Fig. 8. 

25 E) The desired node floor reaction force of a leaf node 
associated with the ground contact portion 10 not in 
contact with the ground is zero. 
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F) Qn, Wn, and Fn (11=1,2,3,4,14, 23, 1423) continuously 
change . 

G) The weight of a leaf node corresponding to the ground 
contact portion 10 in a no-contact-with-ground state or 
the weight of any one of the ancestor nodes of the leaf 
node is zero. 

Incidentally, a desired node floor reaction force 
may be determined on the basis of each desired node floor 
reaction force central point in place of determining it on 
the basis of a weight as described above. More 
specifically, each desired node floor reaction force 
central point may be determined such that the aforesaid 
conditions A) to C) are satisfied, then each weight may be 
determined on the basis of the desired node floor reaction 
force central point and the aforesaid expressions 1 to 3, 
and then the desired node floor reaction force may be 
determined according to the aforesaid expression 4 by 
using the determined weight. 

Returning to the explanation of Fig. 2, the posture 
error calculator 103 calculates the error of an actual 
body posture with respect to a desired body posture and 
outputs the calculated error to the robot 1. In the 
present embodiment, the posture error calculator 103 
receives an inclination angle of the body 24 relative to 
the vertical direction detected by the posture sensor 36 
(hereinafter referred to as the actual body posture 
inclination) and a desired body position/posture 
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determined by the gait generating device 100 (specifically 
the inclination angle in a desired body posture relative 
to the vertical direction; hereinafter referred to as the 
desired body posture inclination) , and then calculates an 
error Gberr between them (Actual body posture inclination 
- Desired body posture inclination; hereinafter referred 
to as the body posture inclination error Gberr) . The 
calculated Gberr is composed of a component about the X 
axis (the component in the roll direction) Gberrx and a 
component about the Y axis (the component in the pitch 
direction) Gberry. If a desired body posture inclination 
is, for example, steadily zero, then Gberr=actual body 
posture inclination, so that a detected value (actual body 
posture inclination) of a posture sensor 36 may be 
directly output as the body posture inclination error 
Gberr . 

Generally speaking, the posture stabilization 
control calculator 104 calculates a compensating total 
floor reaction force, which is a compensation amount of a 
total floor reaction force (the correction amount of a 
desired total floor reaction force) for stabilizing the 
posture of the robot 1 according to the state of the robot 
1 that is detected or estimated on the basis of the 
information of a sensor provided in the robot 1, such as 
the aforesaid body posture inclination error. 

To stabilize the posture of the robot 1 in the long 
term, a translational force and a moment necessary to 
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restore the actual position/posture of a predetermined 
portion, such as the body 24, of the robot 1 to a desired 
position/posture are determined, and this has to be 
additionally generated, the desired total floor reaction 
force central point (desired ZMP) being the point of 
action. The additional translational force and moment are 
referred to as a compensating total floor reaction force. 
The moment component of a compensating total floor 
reaction force is referred to as a "compensating total 
floor reaction force moment Mdmd" (specifically, a 
compensating total floor reaction force moment Mdmd about 
a desired total floor reaction force central point 

(desired ZMP) ) . 

In the present embodiment, the posture stabilization 
control calculator 104 calculates the compensating total 
floor reaction force moment Mdmd so as to restore 

(approximate) an actual body posture inclination to a 
desired body posture inclination. Hence, the body posture 
inclination errors Gberr (Gberrx, Bberry) determined by 
the posture error calculator 103 are input to the posture 
stabilization control calculator 104. 

The posture stabilization control calculator 104 
calculates the compensating total floor reaction force 
moment Mdmd on the basis of the input body posture 
inclination error 6berr. The calculated Mdmd is composed 
of a component about the X axis Mdmdx and a component 
about the Y axis Mdmdy. 
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Specifically, Mdmdx and Mdmdy are determined by, for 
example, the feedback control law (PD control law here) of 
expressions 5 and 6 given below. More specifically, Mdmdx 
and Mdmdy are determined so that the body posture 
5 inclination errors Gberrx and 0berry approximate zero. 

Mdmdx = -Kthx*0berrx-Kwx* (d0berrx/dt ) ... Expression 5 

Mdmdy = -Kthy*0berry-Kwy* (d0berry/dt ) ... Expression 6 

10 where Kthx, Kthy, Kwx and Kwy denote predetermined gains. 

Further, (d0berrx/dt) and (d0berry/dt) denote the time 
differential values of the body posture inclination errors 
0berrx and 0berry, respectively. 

In the present embodiment, a component of the 

15 compensating total floor reaction force moment Mdmd about 
the Z axis (the component in the yaw direction) Mdmdz is 
not used, so that Mdmdz is not determined; however, Mdmdz 
may be determined to prevent the robot 1 from spinning 
(slippage about the vertical axis) . A method for 

20 determining Mdmdz is explained in detail in Japanese 
Patent Application No. 2003-185613 or Japanese Patent 
Application No. 2003-185930 previously proposed by the 
present applicant. Moreover, for example, to restore the 
position of an actual center-of -gravity of the robot 1 to 

25 the position of the center-of -gravity in a desired gait, 
the translational force of a compensating total floor 
reaction force can be determined on the basis of a 
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positional error of the center-of -gravity . 

The floor reaction force detector 108 detects the 
actual floor reaction forces, which are the actual values 
of the floor reaction forces acting on the ground contact 
portions 10 of the actual robot 1 (that is, the actual 
floor reaction forces of leaf nodes (actual node floor 
reaction forces) ) on the basis of the outputs of the six- 
axis force sensor 34 of the legs #1 to #4. In addition, 
the floor reaction force detector 108 calculates the 
relative positions/postures (the relative positions in the 
first embodiment) of the ground contact portions 10 
relative to the coordinate system fixed to the body 24 on 
the basis of the actual joint displacements of the joints 
14 and 15 (the actual rotational angles of the joints 14 
and 15 about individual rotational axes) of the legs #1 to 
#4 detected by sensors, such as encoders, (not shown) 
provided on the joints 14 and 15 of the robot 1. At this 
time, joint displacement commands, which are the 
displacement command values (rotational angle command 
values) of the joints 14 and 15, may be used in place of 
actual joint displacements, or both actual joint 
displacements and joint displacement commands may be used. 
Then, based on the calculated relative positions/postures 
of the ground contact portions 10, the detected values of 
the six-axis force sensor 34 of the legs #1 to #4 (these 
being the values on a local coordinate system fixed to the 
six-axis force sensor 34 or the like) are coordinate- 
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converted to calculate actual floor reaction forces 
represented on the coordinate system fixed to the body 24, 
and then the calculated actual floor reaction forces are 
converted into the actual floor reaction forces 
represented on a supporting leg coordinate system (global 
coordinate system) . For the coordinate conversion into 
the supporting leg coordinate system, detected values of 
the posture sensor 36 or desired body posture inclinations 
may be used. Supplementally, in the robot 1 according to 
the first embodiment, no floor reaction force moment acts 
on the central points of the ground contact portions 10, 
as described above, so that there is no need to detect a 
moment component in the actual floor reaction force of 
each ground contact portion 10. In this case, as 
mentioned above, in place of the six-axis force sensor 34, 
a three-axis force sensor may be used to detect 
translational force components of actual floor reaction 
forces in three axes, or a one-axis floor reaction force 
sensor may be used to detect only translational force 
vertical components of actual floor reaction forces. 

Based on a final desired trajectory of each ground 
contact portion position/posture (this being determined by 
a hierarchical compliance operation determiner 114, which 
will be discussed later) and desired body position/posture 
or the like, the robot geometric model (inverse kinematics 
calculator) 110 performs inverse kinematics calculation to 
calculate joint displacement commands, which are the 



- 110 - 



command values of the displacements (rotational angles) of 
the joints 14 and 15 of the robot 1, that satisfy the 
above. In the present embodiment, the equation of the 
solution of the inverse kinematics calculation has been 
5 determined beforehand, and the joint displacement commands 
have been calculated simply by substituting desired body 
position/posture and the final desired position of each 
ground contact portion into the equation. More 
specifically, the robot geometric model 110 receives a 

10 desired body position/posture trajectory determined by the 
gait generating device 100 and a corrected desired ground 
contact portion trajectory corrected as will be discussed 
later by the hierarchical compliance operation determiner 
114 (a corrected desired ground contact portion trajectory 

15 with deformation compensation), and calculates the joint 
displacement commands of the joints 14 and 15 of the legs 
#1 to #4 by the inverse kinematics calculation from the 
received values. 

In the case of a robot having joints, such as arm 

20 joints and a neck joint, in addition to leg joints, as in 
the sixth embodiment to be discussed later, the 
displacements of joints other than the leg joints are 
determined by the inverse kinematics calculation on the 
basis of the relative posit ions /postures of hands, the 

25 head or the like with respect to the body. 

The displacement controller 112 receives the actual 
joint displacements (detected values) of the joints 14 and 



15 of the robot 1 and the joint displacement commands 
calculated by the robot geometric model (inverse 
kinematics calculator) 110, and controls (feedback- 
control) actuators (not shown) of the joints 14 and 15 by 
using the joint displacement commands as the desired 
values such that the actual joint displacements follow the 
desired values. 

The hierarchical compliance operation determiner 114 
corrects a desired ground contact portion trajectory such 
that an actual total floor reaction force approximates the 
resultant force of a desired total floor reaction force 
and a compensating total floor reaction force, and outputs 
a corrected desired ground contact portion 

position/posture trajectory with deformation compensation, 
which is the desired ground contact portion trajectory 
after the correction. In the present embodiment, the 
postures of the ground contact portions 10 cannot be 
controlled; therefore, the corrected desired ground 
contact portion position/posture trajectory with 
deformation compensation is actually a corrected desired 
ground contact portion position trajectory with 
deformation compensation . 

The hierarchical compliance operation determiner 114 
generally corrects the desired ground contact portion 
trajectories of the ground contact portions 10 so as to 
satisfy the following three requirements as much as 
possible . 



Requirement 1) In order to stabilize the position/posture 
of the robot 1, an actual total floor reaction force is 
made to follow the resultant force of a compensating total 
floor reaction force (moment Mdmd) output by the posture 
stabilization control calculator 104 and a desired total 
floor reaction force. According to the first embodiment, 
in order to stabilize the posture inclination (the 
inclination relative to the vertical direction) of the 
body 24 of the robot 1, the horizontal component of an 
actual total floor reaction force moment about a desired 
total floor reaction force central point is made to follow 
horizontal components Mdmdx and Mdmdy of the compensating 
total floor reaction force moment Mdmd. Supplementally, 
the horizontal component of the desired total floor 
reaction force moment about the desired total floor 
reaction force central point is zero, so that the 
resultant force of this and Mdmd agrees with Mdmd. 
Requirement 2) The absolute value of the actual floor 
reaction force moment about a desired floor reaction force 
central point of each node, which is not a leaf node, is 
minimized as much as possible to prevent an actual floor 
reaction force from being focused on some ground contact 
portions 10 of a plurality of ground contact portions 10 
to be in contact with the ground, causing the actual floor 
reaction force on other ground contact portions 10 to be 
excessively reduced, which will lead to extremely 



deteriorated ground contacting properties of the ground 
contact portions 10 having the reduced actual floor 
reaction force. In the first embodiment, the absolute 
values of the actual floor reaction force moments about 
the desired floor reaction force central points of the 
14th node, the 23rd node and the 1423rd node are minimized 
as much as possible. 

Requirement 3) In order to secure the ground contacting 
properties of the ground contact portions 10 to be in 
contact with the ground, that is, to prevent local ground 
contacting properties of the ground contact portions 10 
from deteriorating due to uneven local ground contact 
pressure distribution (the distribution of an actual floor 
reaction force) in the ground contact portions 10, the 
absolute values of the actual floor reaction force moments 
about the desired floor reaction force central points of 
the ground contact portions 10 (leaf nodes) are minimized 
as much as possible. However, in the robot 1 of the first 
embodiment, the actual floor reaction force moments about 
the desired floor reaction force central points of the 
ground contact portions 10 are always zero; therefore, it 
is unnecessary to consider this requirement 3) . 

In general, it is impossible to fully satisfy all of 
requirements 1) to 3) or requirements 1) and 2) . For 
example, it is often physically impossible to zero the 
actual floor reaction force moments about the desired 
floor reaction force central points of the ground contact 



portions 10 while making an actual total floor reaction 
force agree with the resultant force of a compensating 
total floor reaction force and a desired total floor 
reaction force. Hence, the hierarchical compliance 
operation determiner 114 usually corrects the desired 
ground contact portion trajectories of the ground contact 
portions 10 at certain compromise points while satisfying 
requirements 1) to 3) or requirements 1) and 2) as much as 
possible . 

The above has given the overviews of the functional 
means (functional components) of the control device 50. 

Supplementally, the hierarchical compliance 
operation determiner 114, the posture stabilization 
control calculator 104 and a robot geometric model 
(inverse kinematics calculator) 110 correspond to the node 
operation control means in the present invention. 

Referring now to the flowchart of Fig. 9, the 
overall operation (arithmetic processing) of the control 
device 50 will be explained in more detail. Fig. 9 is a 
flowchart (structured flowchart) showing the main routine 
processing of the control device 50. The components of 
the control device 50 carrying out pertinent processing 
are shown on the left in Fig. 9. 

First, the initialization of the control device 50 
is performed in S10, then the processing advances to S14 
via S12. The arithmetic processing of the control device 
50 waits for a timer interrupt for each control cycle. 
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The control cycle is, for example, 50 ms . 

Subsequently, the processing proceeds to S16 wherein 
it determines whether a gait change is observed, and if 
the determination result is NO, then it proceeds to S22, 
5 which will be discussed later. If the determination 

result in S16 is YES, then the processing proceeds to S18 
wherein it initializes time t to zero, and proceeds to S20 
wherein it sets gait parameters. In the present 
embodiment, for example, a desired gait of a predetermined 

10 period from the moment a predetermined leg (e.g., #1) of 
the robot 1 leaves a floor to the moment it leaves the 
floor next (or from the moment it lands to the moment it 
lands next) is taken as a unit, and gait parameters that 
are the parameters defining the desired gait for the 

15 predetermined period (the parameters used in the algorithm 
for determining the desired gait) are set in S20. The 
"gait change" mentioned in S16 means the change of the 
desired gait for the predetermined period. Whether the 
desired gait is changing may be determined mainly on the 

20 basis of time or a detected value of the six-axis force 
sensor 34 on the predetermined leg. 

The gait parameters set in S20 are composed of 
motion parameters that define the desired motion 
trajectories (specifically, a desired ground contact 

25 portion trajectory and a desired body position/posture 
trajectory) of the robot 1 and the floor reaction force 
parameters that define desired floor reaction force 



trajectories (specifically, a desired total floor reaction 
force trajectory and a desired total floor reaction force 
central point trajectory). Supplementally, once the 
desired motion of the robot 1 is determined, the desired 
total floor reaction force can be obtained by reversing 
the sign of the resultant force of the inertial force 
generated by the desired motion and the gravity acting on 
the robot 1, so that the floor reaction force parameters 
may be the ones that define only a desired total floor 
reaction force central point trajectory. Further, motion 
parameters do not have to include parameters that define a 
desired body position/posture trajectory if a desired 
ground contact portion trajectory (more generally, the 
parameter of a desired motion other than desired body 
position/posture) and a desired total floor reaction force 
central point are determined, and then desired body 
position/posture are determined using a dynamic model of 
the robot 1 such that the horizontal component of a moment 
generated about a desired total floor reaction force 
central point (desired ZMP) by the resultant force of the 
inertial force generated by a desired motion, including 
desired body position/posture of the robot 1, and the 
gravity acting on the robot 1 becomes zero. 

Subsequently, the processing proceeds to S22 wherein 
the instantaneous value of a desired gait is determined on 
the basis of the aforesaid gait parameters. Here, 
"instantaneous value" means a value for each control cycle, 
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and a desired gait instantaneous value is composed of the 
instantaneous values of desired body position/posture, a 
desired ground contact portion position (the instantaneous 
value of a desired ground contact portion trajectory) , a 
desired total floor reaction force, and a desired total 
floor reaction force central point position (a desired ZMP 
position) . In the present embodiment, the postures of the 
ground contact portions 10 cannot be controlled, so that 
the instantaneous values of the desired postures of the 
ground contact portions 10 are not determined. In a case 
where the postures of the ground contact portions can be 
controlled, the parameters defining the desired postures 
of the ground contact portions may be included in the gait 
parameters and the instantaneous values of the desired 
postures of the ground contact portions may be determined 
on the basis of the parameters. 

The processing of S14 to S22 described above is the 
processing carried out by the gait generating device 100. 

Subsequently, the processing proceeds to S24 wherein 
the weight Wn (n=l, 2, 3, 4, 14, 23) of each node and a desired 
floor reaction force central point of each node (a desired 
node floor reaction force central point) 

Qn (n=l, 2, 3, 4, 14, 23) are determined. This processing is 
the processing carried out as described above by the 
desired floor reaction force distributor 102. 

Subsequently, the processing proceeds to S26 wherein 
desired node floor reaction forces (including at least the 



- 118 - 



desired floor reaction forces of the ground contact 
portions 10 (leaf nodes) ) are determined. In the first 
embodiment, the desired node floor reaction forces of leaf 
nodes (desired ground contact portion floor reaction 
forces) are determined. This processing of S26 is also 
the processing carried out as described above by the 
desired floor reaction force distributor 102. As 
described above, if the compliance mechanisms are provided 
on other portions in addition to the distal portions of 
the legs #1 to #4, then the desired floor reaction forces 
of intermediate nodes that are not leaf nodes should be 
also determined. Supplementally, the moment horizontal 
component of a desired node floor reaction force is zero. 

Subsequently, the processing proceeds to S28 wherein 
the state of the robot 1, such as the actual body posture 
inclination, is detected from an output of the posture 
sensor 36 or the like. In the first embodiment, the value 
of an actual body posture inclination detected by the 
posture sensor 36 is captured by the posture error 
calculator 103, and a body posture inclination error Gberr 
is calculated from the detected value and the desired body 
posture inclination (the instantaneous value at the 
current time) out of the desired body position/posture. 

Subsequently, the processing proceeds to S30 wherein 
a compensating total floor reaction force for stabilizing 
the posture of the robot 1 is determined from the state of 
the robot 1 detected in S28. In the first embodiment, the 
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horizontal components Mdmdx and Mdmdy of a compensating 
total floor reaction force moment Mdmd about a desired 
total floor reaction force central point (desired ZMP) are 
calculated by the posture stabilization control calculator 
5 104 from the body posture inclination error Bberr 

according to the above expression 5 and expression 6. 

Subsequently, the processing proceeds to S32 wherein 
the actual floor reaction force of each ground contact 
portion 10 is detected. This is the processing carried 

10 out by the actual floor reaction force detector 108. As 

described above, the actual floor reaction force for each 
ground contact portion 10 detected by the six-axis force 
sensor 34 that is converted to a supporting leg coordinate 
system (global coordinate system) is determined. 

15 Hereinafter, the actual floor reaction force of each 

ground contact portion 10 may be referred to as an actual 
ground contact portion floor reaction force in some cases. 

Subsequently, from S34 to S38, the processing of the 
hierarchical compliance operation determiner 114 is 

20 carried out. 

For a while, the following will explain the overall 
processing of the hierarchical compliance operation 
determiner 114 before the processing of these S34 to S38 
is specifically explained. In this explanation, for the 

25 convenience of understanding, the state shown in Fig. 3(b) 
mentioned above (the state wherein all the legs #1 to #4 
of the robot 1 are supporting legs) will be primarily 
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taken as an example. 

The hierarchical compliance operation determiner 114 
determines the translational force components and moment 
components of the desired node floor reaction forces of 
nodes excluding leaf nodes (more specifically, the 
translational force components and the moment components 
that have desired node floor reaction force central points 
as the points of action) mainly on the basis of the 
desired node floor reaction forces of the leaf nodes 
determined by the desired floor reaction force distributor 
102 . 

The translational force components of the desired 
floor reaction forces (desired node floor reaction forces) 
of the nodes in the state shown in Fig. 3(b) are 
illustratively shown in Fig. 10. In this figure, a vector 
Fn_ref ( n=l , 2 , 3 , 4 , 1 4 , 2 3 ) denotes the translational force 
component of a desired n-th node floor reaction force. 
Further, Ftotalref denotes the translational force 
component of a desired total floor reaction force (= 
desired 1423rd node floor reaction force) . As shown in 
Fig. 8 mentioned above, a desired n-th node floor reaction 
force of an arbitrary n-th node (n=14, 23, 1423) , which is 
not a leaf node, is determined by the resultant force of 
the desired node floor reaction forces of all child nodes 
of the n-th node. Therefore, F14ref =Flref +F4ref , 
F23ref =F2ref +F3ref , and Ftotalref (=F1423ref ) =F14ref +F23ref 
The hierarchical compliance operation determiner 114 
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determines the translational force components 
F14ref (=Flref +F4ref ) and F23ref (=F2ref +F3ref ) of the 
desired node floor reaction forces of intermediate nodes, 
as described above, from the translational force 
5 components Fn_ref (n=l , 2 , 3 , 4 ) of the desired node floor 
reaction forces of the leaf nodes (the ground contact 
portion 10) determined by the desired floor reaction force 
distributor 102. Ftotalref (=F1423ref) is set to the 
translational force component of the desired total floor 
10 reaction force determined by the gait generating device 

100 . 

Furthermore, the hierarchical compliance operation 
determiner 114 determines the moment component of a 
desired node floor reaction force of each node, excluding 

15 leaf nodes, a desired node floor reaction force central 
point being the point of action, as in the case of the 
translational force component of a desired node floor 
reaction force. In this case, however, according to the 
definition of a desired node floor reaction force central 

20 point Qn (n=l, 2, 3, 4, 14, 23) , the moment horizontal 

component of a desired n-th node floor reaction force is 
always set to zero. The moment horizontal component of a 
desired 1423rd node floor reaction force (= desired total 
floor reaction force) is also set to zero. 

25 In the robot 1 of the present embodiment, the ground 

contact portions 10 are engaged with the spherical joints 
12 (free joints) at the distal end portions of the legs #1 
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to #4, so that floor reaction force moments (horizontal 
components and vertical components) cannot be generated in 
the ground contact portions 10 (leaf nodes) . For this 
reason, in the hierarchical compliance operation 
5 determiner 114, the moment vertical components of the 

desired node floor reaction forces of the ground contact 
portions 10 (leaf nodes) are also set to zero. 

If a desired node floor reaction force moment 
vertical component of a node that is not a leaf node is 

10 determined so as to dynamically balance with a desired 

motion of the robot 1, then it could generally take a non- 
zero value; however, in the present embodiment, the 
control related to the rotation (the rotation in the yaw 
direction) of the posture of the robot 1 about the 

15 vertical axis is not carried out. In the present 
embodiment, therefore, the setting of the vertical 
component of the moment of a desired node floor reaction 
force of a node that is not a leaf node will be omitted. 
For this reason, the moment components of desired node 

20 floor reaction forces in the state shown in Fig. 3(b) will 

not be shown. If the control related to the rotation of 
the posture of the robot 1 about the vertical axis is 
carried out, then the desired floor reaction force moment 
vertical components of the nodes should be also set. 

25 Supplementally, if the translational force 

components and the moment components of the desired node 
floor reaction forces of the nodes, including leaf nodes, 



are determined by the desired floor reaction force 
distributor 102, then the determination need not be 
performed by the hierarchical compliance operation 
determiner 114. 

Further, the hierarchical compliance operation 
determiner 114 also determines the translat ional force 
component and the moment component of an actual node floor 
reaction force, which is the actual floor reaction force 
of each node. 

The translational force components of the actual 
floor reaction forces of the nodes (actual node floor 
reaction forces) in the state shown in Fig. 3(b) are 
illustratively shown in Fig. 11. In the diagram, a vector 
Fn_act (n=l, 2, 3, 4, 14, 23) denotes a translational force 
component of an actual n-th node floor reaction force. 
Further, Ftotalact denotes the translational force 
component of an actual total floor reaction force (= 
actual 1423rd node floor reaction force) . In general, the 
translational force component of the actual floor reaction 
force of each node that is not a leaf node is the 
resultant force of the translational force components of 
the actual floor reaction forces of all child nodes of the 
node. Accordingly, the translational force components of 
the actual floor reaction forces of the 14th node, the 
23rd node, and the 1423rd node are F14act=Flact+F4act , 
F23act=F2act+F3act, Ftotalact (=F1423act) =F14act+F23act . 
The translational force components Flact, F2act, F3act and 



F4act of the actual floor reaction forces of the leaf 
nodes are the translational force components of the actual 
floor reaction forces (actual ground contact portion floor 
reaction forces) of the ground contact portions 10 
obtained by the actual floor reaction force detector 108. 
The vectors shown by dashed lines in Fig. 11 indicate the 
translational force components of the desired node floor 
reaction forces shown in Fig. 10 mentioned above. The 
hierarchical compliance operation determiner 114 
determines the translational force components of the 
actual node floor reaction forces of the nodes from the 
actual floor reaction forces of the ground contact 
portions 10 obtained by the actual floor reaction force 
detector 108 . 

The moment components of the actual floor reaction 
forces of the nodes in the state shown in Fig. 3(b) are 
illustratively shown in Fig. 12. In the diagram, a vector 
Mn_act (n=14, 23, 1423) denotes the moment component of an 
actual n-th node floor reaction force. In this case, as 
with the translational force components of the actual 
floor reaction forces of the nodes, in general, the moment 
component of an actual floor reaction force M14act, M23act 
or M1423act (=Mtotalact) of a node that is not a leaf node 
is defined as the moment component of the resultant force 
of the actual floor reaction forces of all child nodes of 
the node (the moment component having the desired floor 
reaction force central point Q14, Q23 or Q1423 of the node 
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as the point of action) . 

In the robot 1 of the present embodiment, no floor 
reaction force moment can be generated in the ground 
contact portions 10 (leaf nodes) , as described above, so 
5 that the moment components of the actual floor reaction 

forces of leaf nodes (actual ground contact portion floor 
reaction forces) will be always zero. Thus, the moment 
components of the actual node floor reaction forces of the 
leaf nodes will not be shown. 

10 The actual floor reaction force moment components of 

nodes that are not leaf nodes (in the present embodiment, 
M14act, M23act and M1423act) are not generally zero. For 
example, a moment is usually generated about the desired 
14th node floor reaction force central point Q14 by the 

15 horizontal components of the translational force 

components of the actual floor reaction forces of the 
first ground contact portion 10 (the 1st node) and the 
fourth ground contact portion 10 (the 4th node) . However, 
in the robot 1 in the present embodiment, the distal end 

20 portions of the legs are provided with the spherical 

joints 12, which are free joints, so that a component in 
the same direction as a segment Q1Q4 of M14act and a 
component in the same direction as a segment Q2Q3 of 
M23act will be zero. 

25 In a robot having the distal joints of its legs 

provided with actuators (a robot in which the postures of 
the distal ground contact portions of the legs are 
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controllable) , even if the control related to the rotation 
of the posture of the robot about the vertical axis is not 
carried out, the desired floor reaction force moment 
horizontal components of the ground contact portions are 
5 also set and the actual floor reaction force moments of 

the ground contact portions are also detected, as shown in 
an embodiment disclosed in Japanese Unexamined Patent 
Application Publication No. H10-277969 previously proposed 
by the present applicant. Then, an operation for 

10 correcting the postures of the ground contact portions 

should be performed so that the actual floor reaction 
force moment horizontal component of each ground contact 
portion approximates a desired floor reaction force moment 
horizontal component or that the actual floor reaction 

15 force moment of each ground contact portion approximates 
the sum (the vector sum) of the desired floor reaction 
force moment horizontal component and its ground contact 
portion compensating floor reaction force moment. 

The processing of the hierarchical compliance 

20 operation determiner 114 will be explained in more detail. 
In this case, a situation is assumed in which the posture 
of the body 24 of the robot 1 is about to fall toward left 
rear in the state shown in Fig. 3(b) and the compensating 
total floor reaction force moment Mdmd determined by the 

25 posture stabilization control calculator 104 is as shown 
in Fig. 13. 

To restore the posture (the inclination relative to 
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the vertical direction) of the body 24 of the robot 1 (to 
restore the inclination in a desired body posture) , the 
horizontal component of an actual total floor reaction 
force moment about a desired total floor reaction force 
central point (a desired ZMP) may be made to follow the 
horizontal component of the sum of a desired total floor 
reaction force moment Mtotalref (=M1423ref) and a 
compensating total floor reaction force moment Mdmd. 

Meanwhile, at the desired total floor reaction force 
central point (the desired ZMP) , the horizontal component 
of the desired total floor reaction force moment Mtotalref 
is zero. Hence, to restore the posture (inclination) of 
the body 24 of the robot 1 in the longitudinal and lateral 
directions, the horizontal component of the actual total 
floor reaction force moment about the desired total floor 
reaction force central point (the desired ZMP) may be made 
to follow the horizontal components (Mdmdx, Mdmdy) of Mdmd. 
Further, in the present embodiment, the actual floor 
reaction force moment about the desired floor reaction 
force central point of each ground contact portion 10 is 
zero . 

Therefore, the hierarchical compliance operation 
determiner 114 in the first embodiment corrects the 
desired ground contact portion position (especially the 
position in the height direction) of each ground contact 
portion 10 determined by the gait generating device 100 so 
as to satisfy the aforesaid requirements 1) and 2) as much 
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as possible. 

To make the correction, the hierarchical compliance 
operation determiner 114 determines a compensating angle. 
The compensating angle is a manipulated variable (a 
5 rotational amount) for correcting the relative 

relationship among the positions of the ground contact 
portions 10 by the operation of rotation about a certain 
point (correcting in the vertical direction in the present 
embodiment) . In the present embodiment, there are a 14th 

10 node compensating angle 014, a 23rd node compensating 

angle 623, and a 1423rd node compensating angle 91423 as 
the compensating angles. In other words, they are the 
compensating angles of the nodes other than leaf nodes. 
Then, the hierarchical compliance operation determiner 114 

15 determines a desired n-th node floor reaction force 

central point Qn' obtained by correcting the desired n-th 
node floor reaction force central point Qn 
(n=l, 2, 3, 4, 14, 23) on the basis of these compensating 
angles 914, 923 and 91423. 

20 As shown in Fig. 15, the 14th node compensating 

angle 914 is the angle formed by a segment Q1Q4 and a 
segment Q1'Q4', and the 23rd node compensating angle 923 
is the angle formed by a segment Q2Q3 and a segment Q2'Q3'. 
Further, as shown in Fig. 16, the 1423rd node compensating 

25 angle 91423 is the angle formed by a segment Q14Q23 and a 
segment Q14'Q23'. The technique for determining these 
node compensating angles 914, 923 and 91423 will be 
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described later . 

Referring to Fig. 15 and Fig. 16, the correction of 
the desired n-th node floor reaction force central point 
Qn (n=l, 2, 3, 4, 14, 23) on the basis of the compensating 
5 angles 914, 023 and 61423 is made as follows. 

Referring to Fig. 15, a normal vector V14 of a plane 
that includes a desired first node floor reaction force 
central point Ql (the desired floor reaction force central 
point of a first ground contact portion 10) and a desired 

10 fourth node floor reaction force central point Q4 (the 

desired floor reaction force central point of a second 
ground contact portion 10) and that is perpendicular to a 
horizontal plane is determined. The magnitude of V14 is 1. 
The coordinate (position) of the desired first node floor 

15 reaction force central point Ql is rotationally moved 

about a normal vector V14 with the desired 14th node floor 
reaction force central point Q14 as the center of rotation 
(about the axis that passes Q14 and is parallel to V14) by 
the aforesaid 14th node compensating angle 914. The point 

20 after Ql is moved by the above rotational movement is 

defined as Ql'. Similarly, the coordinate (position) of 
the desired fourth node floor reaction force central point 
Q4 is rotationally moved about the normal vector V14 by 
the 14th node compensating angle 914, the desired 14th 

25 node floor reaction force central point being the center 
of rotation. The point after Q4 is moved by the above 
rotational movement is defined as Q4'. In other words, 
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the ends of a segment obtained by rotating the segment 
Q1Q4 about V14 by 614 with Q14, which is an internally 
dividing point thereof, as the center of rotation are 
defined as Ql' and Q4'. Thus, the 14th node compensating 
5 angle 614 is a manipulated variable for moving the 

relative relationship of the positions of the desired 
floor reaction force central points Ql and Q4 of the first 
node and the fourth node, respectively, which are child 
nodes of the 14th node, without moving the position of the 
10 desired floor reaction force central point Q14 of the 14th 
node . 

Moreover, a normal vector V23 of a plane that 
includes a desired second node floor reaction force 
central point Q2 and a desired third node floor reaction 

15 force central point Q3 and that is perpendicular to a 

horizontal plane is dete rmined. The magnitude of V23 is 1. 
The coordinate (position) of the desired second node floor 
reaction force central point Q2 is rotationally moved 
about the normal vector V23 with the desired 23rd node 

20 floor reaction force central point Q23 as the center of 
rotation (about the axis that passes Q23 and is parallel 
to V23) by the 23rd node compensating angle 623. As shown 
in Fig. 15, the point after Q2 is moved by the above 
rotational movement is defined as Q2'. Similarly, the 

25 coordinate (position) of the desired third ground contact 
portion floor reaction force central point Q3 is 
rotationally moved about the normal vector V23 by the 23rd 
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node compensating angle 023, the desired 23rd node floor 
reaction force central point being the center of rotation. 
The point after Q3 is moved by the above rotational 
movement is defined as Q3' . In other words, the ends of a 
5 segment obtained by rotating the segment Q2Q3 about V23 by 

023 with Q23, which is an internally dividing point 
thereof, as the center of rotation are defined as Q2' and 
Q3' . Thus, the 23rd node compensating angle 023 is a 
manipulated variable for moving the relative relationship 

10 of the positions of the desired floor reaction force 

central points Q2 and Q3 of the second node and the third 
node, respectively, which are child nodes of the 23rd node, 
without moving the position of the desired floor reaction 
force central point Q23 of the 23rd node. 

15 Next, referring to Fig. 16, a normal vector V1423 of 

a plane that includes a desired 14th node floor reaction 
force central point Q14 and a desired 23rd node floor 
reaction force central point Q23 and that is perpendicular 
to a horizontal plane is determined. The magnitude of 

20 V1423 is 1. The coordinate (position) of the desired 14th 
node floor reaction force central point Q14 is 
rotationally moved about the normal vector V1423 by the 
1423rd compensating angle 01423, the desired total floor 
reaction force central point P (=Q1423) being the center 

25 of rotation (about the axis that passes P and is parallel 
to V1423) . The point after Q14 is moved by the above 
rotational movement is defined as Q14'. Similarly, the 



- 132 - 



coordinate (position) of the desired 23rd ground contact 
portion floor reaction force central point Q23 is 
rotationally moved about the normal vector V1423 by the 
1423rd compensating angle 01423, the desired total floor 
5 reaction force central point P being the center of 

rotation. The point after Q23 is moved by the above 
rotational movement is defined as Q23' . In other words, 
the ends of a segment obtained by rotating a segment 
Q14Q23 about V1423 by 01423, using P(=Q1423), which is an 

10 internally dividing point thereof, as the center of 

rotation are defined as Q14' and Q23'. Thus, the 1423rd 
node compensating angle 01423 is a manipulated variable 
for moving the relative relationship of the positions of 
the desired floor reaction force central points Q14 and 

15 Q23 of the 14th node and the 23rd node, respectively, 

which are child nodes of the 1423rd node, without moving 
the position of the desired floor reaction force central 
point P of the 1423rd node. 

Hereinafter, generally, a vector whose start point 

20 is A and end point is B will be denoted as a vector A_B . 

Next, a point Ql" that would be obtained when Ql' is 
moved by a vector Q14_Q14' is determined. Similarly, a 
point Q4" that would be obtained when Q4'is moved by a 
vector Q14_Q14' is determined. Further, a point Q2" that 

25 would be obtained when Q2' is moved by a vector Q23_Q23' 
is determined. Similarly, a point Q3" that would be 
obtained when Q3' is moved by a vector Q23_Q23' is 
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determined . 

Subsequently, the desired ground contact portion 
position of an n-th ground contact portion (n=l,2,3,4) is 
moved in parallel by a vector Qn_Qn" (substantially 
5 vertical movement) . This corrects the desired ground 

contact portion position of each ground contact portion 10. 
Supplementally, as with the desired floor reaction force 
central point of each node, if the position of each leaf 
node is set to the position of the ground contact portion 

10 10 corresponding to the leaf node, and the position of 

each node having child nodes is defined as a weighted 
average position of the positions of all child nodes of 
the node, using the weights set as described above, then 
the processing for moving the desired floor reaction force 

15 central points of the child nodes of the 14th node, the 

23rd node and the 1423rd node, respectively, according to 
the compensating angles 014, 023 and 01423, as described 
above, is equivalent to moving the positions of the child 
nodes of the 14th node, the 23rd node and the 1423rd node, 

20 respectively, according to the compensating angles 014, 
023 and 01423. 

In a robot in which the distal end portions of its 
legs have no free joints (a robot in which the postures of 
ground contact portions can be controlled) , the aforesaid 

25 parallel movement is performed without changing the 

postures (desired postures) of ground contact portions, 
and then the n-th ground contact portion is further 



rotated by a certain rotational angle 0n_x about a 
longitudinal axis (X axis) and also rotated about a 
lateral axis (Y axis) by a certain rotational angle 0n_y, 
with Qn" being the center. This corrects the desired 
postures of ground contact portions. The rotational angle 
0n (a two-dimensional amount composed of 9n_x and 0n_y) in 
this case is referred to as an n-th ground contact portion 
compensating angle, 0n_x is referred to as an n-th ground 
contact portion compensating angle X component, and 0n_y 
is referred to as an n-th ground contact portion 
compensating angle Y component. The n-th ground contact 
portion compensating angle 0n may be determined according 
to the technique described in Japanese Unexamined Patent 
Application Publication No. H10-277969 previously proposed 
by the present applicant. 

Supplementally, each of the node compensating angles 
is determined such that a resultant force of a desired 
floor reaction force moment (the horizontal component 
thereof is zero) and a node compensating floor reaction 
force moment Mn_dmd is generated at the desired node floor 
reaction force central point of the node, which is the 
point of action. In this case, the compensating total 
floor reaction force moment Mdmd, which provides the basis 
of the node compensating floor reaction force moment 
Mn_dmd, is determined so that an actual posture 
inclination error approximates zero. Hence, each node 
compensating angle will function as a manipulated variable 
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for manipulating the relative positional relationship 
among the ground contact portions 10 so that an actual 
posture inclination error approximates zero while bringing 
a floor reaction force moment about a desired total floor 
5 reaction force central point close to a desired moment (a 
compensating total floor reaction force moment in this 
case) . 

As described above, the processing for correcting 
the desired ground contact portion positions (specifically, 

10 the mutual relative relationship among the positions) of 

the ground contact portions 10 is the hierarchical 
compliance operation in the first embodiment. In the 
compliance operation, for each node having child nodes, 
the manipulated variable (correction amount) of the 

15 relative relationship among the desired ground contact 
portion positions (relative positional relationship) of 
the ground contact portions 10, which are the descendant 
nodes of the node, is established for each of the 
compensating angles 014, 023 and 01423, and the 

20 manipulated variables (correction amounts) are combined so 
as to correct the mutual relative relationship of the 
desired ground contact portion positions of the ground 
contact portions 10. The desired ground contact portion 
position/posture corrected as described above is referred 

25 to as a corrected desired ground contact portion 
position/posture . 

In such a compliance operation, generally, if the 
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aforesaid compensating angles (compensating operation 
amounts) are not excessive, then the ground contact region 
(a region of the ground contact surface wherein the 
pressure is positive) remains unchanged even if the ground 
5 contact pressure distribution of each ground contact 
portion 10 changes. In this case, the compliance 
mechanism 42 attached to each ground contact portion 10 
deforms in proportion to a compensating angle, and an 
actual floor reaction force of each ground contact portion 

10 10 based on the amount of the deformation is generated. 

As a result, the relationship between the compensating 
angles and the changing amounts of the actual floor 
reaction forces generated by the compensating angles has 
good characteristics, namely, linear characteristics, 

15 shown below. 

Characteristic 1) If only the compensating angles about 
the desired floor reaction force central points of nodes 
that are not leaf nodes are manipulated to move the 

20 desired ground contact portion positions of the ground 
contact portions 10, then the translational force 
components of the actual floor reaction forces of the 
ground contact portions 10 that have been lowered increase, 
while the translational force components of the actual 

25 floor reaction forces of the ground contact portions 10 

that have been raised decrease. At this time, the actual 
floor reaction force moments about the corrected desired 
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floor reaction force central point of the ground contact 
portions 10 (leaf nodes) hardly change. 

Characteristic 2) If only an n-th ground contact portion 
compensating angle is manipulated to rotate the desired 
5 posture of the n-th ground contact portion, then the 

moment component of the actual floor reaction force acting 
on the desired floor reaction force central point of the 
n-th ground contact portion changes, while the 
translational force component does not change much. 

10 Characteristic 3) If the compensating angle about the 

desired floor reaction force central point of a node that 
is not a leaf node and an n-th ground contact portion 
compensating angle are simultaneously manipulated, then 
the change amount of the actual floor reaction forces of 

15 the ground contact portions 10 will be equivalent to the 
sum of the change amount observed when each of them is 
independently manipulated . 

Fig. 17 is a block diagram showing the functions of 
the hierarchical compliance operation determiner 114 in 

20 the present embodiment. Referring to the diagram, the 
processing of the hierarchical compliance operation 
determiner 114 will be explained in further detail. 

The hierarchical compliance operation determiner 114 
is equipped with, as its functional means, a compensating 

25 total floor reaction force moment distributor 114a, 

compensating angle determiners 114b, 114c and 114d, a 
corrected desired ground contact portion position/posture 
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calculator 114g, a deformation compensation amount 
calculator 114n, and a corrected desired ground contact 
portion position/posture with deformation compensation 
calculator 114h. 
5 The compensating total floor reaction force moment 

distributor 114a distributes the aforesaid compensating 
total floor reaction force moment Mdmd (Mdmdx, Mdmdy) to 
the 1423rd node compensating floor reaction force moment 
M1423dmd, the 14th node compensating floor reaction force 

10 moment M14dmd, and the 23rd node compensating floor 
reaction force moment M23dmd. 

The 1423rd node compensating floor reaction force 
moment M1423dmd is the desired value of a moment to be 
generated about the desired 1423rd node floor reaction 

15 force central point (= desired total floor reaction force 
central point (desired ZMP) ) by the translational force 
components of the floor reaction forces of the ground 
contact portions 10 (specifically, the first to the fourth 
ground contact portions) when the 1423rd compensating 

20 angle 01423 is manipulated. 

The component of the 1423rd node compensating floor 
reaction force moment M1423dmd in the direction of the 
aforesaid vector V1423 (the component about the axis in 
the V1423 direction) is described as M1423dmdv. The 

25 vector V1423 is the vector defined in the general 
explanation of the compliance operation of the 
hierarchical compliance operation determiner 114 (refer to 
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Fig. 16) . If a vector orthogonal to V1423 and also 
orthogonal to the vertical direction is defined as U1423, 
then the component in the direction of U1423 of the 1423rd 
node compensating floor reaction force moment M1423dmd 
5 (the component about the axis in the U1423 direction) 

M1423dmdu is set to zero in the present embodiment. This 
is because the component of a floor reaction force moment 
in the U1423 direction cannot be generated even if the 
1423rd node compensating angle 01423 is manipulated in the 

10 robot 1 of the present embodiment. Further, in the 

present embodiment, the rotation of the posture of the 
robot 1 about the vertical axis is not controlled; 
therefore, the component M1423dmdz of M1423dmd in the 
vertical direction is also set to zero. 

15 The 14th node compensating floor reaction force 

moment M14dmd is the desired value of a moment to be 
generated about the desired 14th node floor reaction force 
central point by the translational force components of the 
floor reaction forces of the ground contact portions 10 

20 (specifically, the first and the fourth ground contact 

portions) when the 14th compensating angle 614 is 
manipulated . 

The component of the 14th node compensating floor 
reaction force moment M14dmd in the direction of the 
25 vector V14 is described as M14dmdv. The vector V14 is the 
vector defined in the general explanation of the 
compliance operation of the hierarchical compliance 
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operation determiner 114 (refer to Fig. 15). If a vector 
orthogonal to V14 and also orthogonal to the vertical 
direction is defined as U14, then the component M14dmdu in 
the direction of U14 of the 14th node compensating floor 
5 reaction force moment M14dmd is set to zero in the present 
embodiment. This is because the component of a floor 
reaction force moment in the U14 direction cannot be 
generated even if the 14th node compensating angle 014 is 
manipulated in the robot 1 of the present embodiment. In 

10 the present embodiment, the component of M14dmd in the 

vertical direction is also set to zero. 

The 23rd node compensating floor reaction force 
moment M23dmd is the desired value of a moment to be 
generated about the desired 23rd node floor reaction force 

15 central point by the translational force components of the 
floor reaction forces of the ground contact portions 10 
(specifically, the second and the third ground contact 
portions) when the 23rd compensating angle 923 is 
manipulated . 

20 The component of the 23rd node compensating floor 

reaction force moment M23dmd in the direction of the 
vector V23 is described as M23dmdv. The vector V23 is the 
vector defined in the general explanation of the 
compliance operation of the hierarchical compliance 

25 operation determiner 114 (refer to Fig. 15). If a vector 
orthogonal to V23 and also orthogonal to the vertical 
direction is defined as U23, then the component M23dmdu in 



the direction of U23 of the 23rd node compensating floor 
reaction force moment M23dmd is set to zero in the present 
embodiment. This is because the component of a floor 
reaction force moment in the U23 direction cannot be 
generated even if the 23rd node compensating angle 623 is 
manipulated in the robot 1 of the present embodiment. In 
the present embodiment, the component of M23dmd in the 
vertical direction is also set to zero. 

The 1423rd node compensating floor reaction force 
moment M1423dmd, the 14th node compensating floor reaction 
force moment M14dmd, and the 23rd node compensating floor 
reaction force moment M23dmd are determined, for example, 
as follows. 

On an arbitrary n-th node, when a desired n-th node 
floor reaction force central point has been corrected 
while maintaining the horizontal component of an n-th node 
compensating floor reaction force moment at zero so as to 
be equivalent to adding the n-th node compensating floor 
reaction force moment to the desired n-th node floor 
reaction force central point, the desired n-th node floor 
reaction force central point position that has been 
corrected is referred to as a corrected desired n-th node 
floor reaction force central point position. 

The relationships between a corrected desired 1423rd 
node floor reaction force central point Pmdfd (=Q1423mdfd) 
a corrected desired 14th node floor reaction force central 
point Q14mdfd, and a corrected desired 23rd node floor 
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reaction force central point Q23mdfd, and node 
compensating floor reaction force moments are shown in the 
following expressions 7 to 9. The desired 1423rd node 
floor reaction force central point Q1423 agrees with the 
5 total floor reaction force central point P, so that the 

corrected desired 1423rd node floor reaction force central 
point Pmdfd may be referred to as a corrected desired 
total floor reaction force central point in some cases. 



10 M1423dmd = ( Pmdf d-P) *Ftotalref ... Expression 7 

M14dmd = (Q14mdf d-Q14 ) *F14ref ... Expression 8 

M23dmd = (Q23mdf d-Q23) *F23ref ... Expression 9 



The difference between two points, such as ( Pmdfd- P) 
15 in expression 7 , means the difference in the positional 
vectors of the points. Further, Ftotalref, F14ref, and 
F23ref denote the translational force components of the 
desired node floor reaction forces of the 1423rd node, the 
14th node, and the 23rd node, respectively, as shown in 
20 Fig. 10. 

To maintain high ground contact properties of the 
robot 1, control should not be carried out to bring the 
floor reaction force of the ground contact portion 10 to 
be in contact with the ground excessively close to zero or 
25 a negative value. Hence, the following conditions 1) to 
3) should be satisfied. 

Corrected node existing position condition 1) 
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Pmdfd is not excessively close to an end of the 
segment Q14Q23 from the total floor reaction force central 
point P and exists on the segment Q14Q23. The range in 
which the corrected desired 1423rd node floor reaction 
5 force central point (corrected desired total floor 

reaction force central point) Pmdfd should exist is 
referred to as the existence permissible range of the 
corrected desired 1423rd node floor reaction force central 
point (corrected desired total floor reaction force 

10 central point) . 

Corrected node existing position condition 2) 

Q14mdfd is not excessively close to an end of the 
segment Q1Q4 from the desired 14th node floor reaction 
force central point Q14 and exists on the segment Q1Q4 . 

15 The range in which the corrected desired 14th node floor 
reaction force central point Q14mdfd should exist is 
referred to as the existence permissible range of the 
corrected desired 14th node floor reaction force central 
point . 

20 Corrected node existing position condition 3) 

Q23mdfd is not excessively close to an end of the 
segment Q2Q3 from the desired 23rd node floor reaction 
force central point Q23 and exists on the segment Q2Q3. 
The range in which the corrected desired 23rd node floor 

25 reaction force central point Q23mdfd should exist is 
referred to as the existence permissible range of the 
corrected desired 23rd node floor reaction force central 
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point . 

Meanwhile, to obtain an appropriate posture 
restoring force actually generated in the robot 1 (the 
5 force for restoring the inclination of the body 24 to a 

desired body posture inclination) , the resultant force of 
the 1423rd node compensating floor reaction force moment 
M1423dmd, the 14th node compensating floor reaction force 
moment M14dmd, and the 23rd node compensating floor 
10 reaction force moment M23dmd should approximately agree 

with the compensating total floor reaction force moment 
Mdmd. In other words, the following expression 10 should 
be approximately satisfied. 

15 Mdmd = M1423dmd + M14dmd + M23dmd . . . Expression 10 

In the present embodiment, therefore, the 1423rd 
node compensating floor reaction force moment M1423dmd, 
the 14th node compensating floor reaction force moment 

20 M14dmd, and the 23rd node compensating floor reaction 
force moment M23dmd are determined according to 
expressions 11 to 13 given below as long as the positions 
of the corrected desired node floor reaction force central 
points Pmdfd, Q14mdfd, and Q23mdfd determined by the above 

25 and the aforesaid expression 7, expression 8, and 
expression 9 satisfy the aforesaid corrected node 
existence position conditions 1), 2) and 3). 
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M1423dmd = Matl42 3*Mdmd*V142 3 . . . Expression 11 

M14dmd = Matl4*Mdmd*V14 . . . Expression 12 

M23dmd = Mat2 3*Mdmd*V2 3 . . . Expression 13 

5 

where Matl423, Matl4, and Mat23 denote gain matrixes (1- 
row, 3-column matrixes with a third element being zero) , 
and these are set such that M1423dmd, M14dmd, and M23dmd 
determined according to expression 11, expression 12, and 

10 expression 13 satisfy expression 10. 

More precisely, the gain matrixes Matl423, Matl4, 
and Mat23 are determined such that a simultaneous equation 
composed of expression 10, expression 11, expression 12, 
and expression 13 identically holds regardless of the 

15 value of Mdmd. The gain matrix for the simultaneous 

equation to identically hold is not uniquely determined, 
so that an appropriate gain matrix may be determined 
depending on, for example, which one of the corrected node 
existence position conditions 1), 2) and 3) is especially 

20 important. Supplementally, the gain matrixes are 

desirably changed continuously in order to continuously 
change the compensating angles 01423, 014, and 023. 
Further, the policy of setting gain matrixes may be 
changed according to whether the robot 1 is standing 

25 upright or the difference in movement mode or the like. 

If the 1423rd node compensating floor reaction force 
moment M1423dmd, the 14th node compensating floor reaction 
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force moment M14dmd, and the 23rd node compensating floor 
reaction force moment M23dmd determined according to 
expression 11, expression 12, and expression 13 do not 
satisfy any one of the corrected node existence position 
5 conditions 1), 2) and 3), then they are to be corrected to 
satisfy the conditions 1), 2) and 3). More specifically, 
of the corrected desired n-th node floor reaction force 
central points (n=1423, 14, 23) , the corrected desired node 
floor reaction force central point that has exceeded the 

10 existence permissible range is set on the boundary of the 
existence permissible range, and the remaining corrected 
desired node floor reaction force central points are 
determined so as to satisfy expression 11, expression 12, 
and expression 13 as much as possible (to minimize the 

15 absolute value of the difference between a left side and a 
right side as much as possible) . Generally, however, the 
behavior of a controlled object does not considerably 
change even if a feedback amount slightly changes in 
feedback control; therefore, it is not required to 

20 strictly or forcibly satisfy expression 11, expression 12 
and expression 13. 

Thus, the compensating total floor reaction force 
moment distributor 114a determines the node compensating 
floor reaction force moments M1423dmd, M14dmd, and M23dmd. 

25 Fig. 14 shows the examples of the node compensating floor 
reaction force moments M1423dmd, M14dmd, and M23dmd 
determined as described above. In the figure, Mdmd is the 
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same as that shown in Fig. 13 mentioned above. 

Moreover, the compensating total floor reaction 
force moment distributor 114a determines the corrected 
desired ground contact portion floor reaction forces 
Fn_refmdfd (n=l,2,3,4), which are the desired floor 
reaction forces of the ground contact portions 10 that are 
corrected by adding node compensating floor reaction force 
moments to desired ground contact portion floor reaction 
forces, on the basis of the desired ground contact portion 
floor reaction forces, which are the desired floor 
reaction forces of the ground contact portions 10 (the 
desired node floor reaction forces of leaf nodes) and the 
node compensating floor reaction force moments M1423dmd, 
M14dmd and M2 3dmd. 

At this time, the corrected desired ground contact 
portion floor reaction forces Fn_refmdfd (n=l,2,3,4) may 
be determined from the desired floor reaction force 
central points Qn (n=l , 2 , 3 , 4 ) , the corrected total floor 
reaction force central points Pmdfd, the corrected desired 
node floor reaction force central points Q14mdfd and 
Q23mdfd, and the desired total floor reaction forces 
Ftotalref of the ground contact portions 10 by the same 
technique as the technique for determining deciding 
desired node floor reaction forces from the desired floor 
reaction force central points (the desired node floor 
reaction force central points of leaf nodes) Qn (n=l , 2 , 3 , 4 ) 
the desired total floor reaction force central points P, 
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the desired node floor reaction force central points Q14 
and Q23, and the desired total floor reaction forces 
Ftotalref of the ground contact portions 10. In other 
words, the weights of the nodes may be determined 
according to the aforesaid expressions 1 to 3 from the 
desired floor reaction force central points Qn (n=l , 2 , 3 , 4 ) , 
the corrected total floor reaction force central points 
Pmdfd, the corrected desired node floor reaction force 
central points Q14mdfd and Q23mdfd of the ground contact 
portions 10, and the corrected desired ground contact 
portion floor reaction forces Fn_refmdfd (n=l,2,3,4) may 
be determined according to the aforesaid expression 4 by 
using the determined weights. 

As is obvious from the above, generating a node 
compensating floor reaction force moment at a desired n-th 
node floor reaction force central point of an n-th node 
having child nodes (correcting the moment component of the 
desired floor reaction force acting on a desired n-th node 
floor reaction force central point) is equivalent to 
correcting the weights of the child nodes of the n-th node. 

The processing of the compensating total floor 
reaction force moment distributor 114a explained above is 
represented by the functional block diagram shown in Fig. 
18. More specifically, based on the desired node floor 
reaction force central points Qn (n=l, 2, 3, 4, 14, 23) , the 
existence permissible ranges of the 14th node, the 23rd 
node, and the corrected desired node floor reaction force 



central points Qn_mdfd (n=14, 23, 1423) are determined 
according to the aforesaid corrected node existence 
position conditions 1), 2) and 3). Further, the corrected 
desired node floor reaction force central points Qn_mdfd 
(n=14, 23, 1423) and the node compensating floor reaction 
force moments Mn_dmd (n=14, 23, 1423) are determined on the 
basis of the compensating total floor reaction force 
moment Mdmd, the desired floor reaction force central 
points of nodes Qn (n=l, 2, 3, 4, 14, 23, 1423) , the desired 
floor reaction forces Fn_ref (n=l, 2, 3, 4, 14, 23, 1423) , and 
the aforesaid existence permissible ranges. In addition, 
the corrected desired ground contact portion floor 
reaction forces Fn_refmdfd (n=l,2,3,4) are determined on 
the basis of the corrected desired node floor reaction 
force central points Qn_mdf d (n=14, 23, 1423) , the desired 
floor reaction force central points Qn (n=l , 2 , 3 , 4 ) of the 
ground contact portions 10, and the desired total floor 
reaction force Ftotalref . 

Next, the processing of the compensating angle 
determiner (01423 determiner) 114b out of the aforesaid 
compensating angle determiners 114b to 114d will be 
explained with reference to the block diagram of Fig. 19. 
If the translational force component (Flact+F4act ) of the 
resultant force of the actual first node floor reaction 
force and the actual fourth node floor reaction force acts 
on a desired 14th node floor reaction force central point 
Q14, and the translational force component (F2act+F3act ) 
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of the resultant force of the actual second node floor 
reaction force and the actual third node floor reaction 
force acts on a desired 23rd node floor reaction force 
central point Q23, then a moment M1423act generated about 
the desired total floor reaction force central point P 
(the desired 1423rd node floor reaction force central 
point) by the above translat ional force components is 
determined according to expression 14 given below. 

M1423act = P_Q14* (Flact+F4act ) +P_Q23* (F2act+F3act ) 

. . . Expression 14 

where P_Q14 denotes a vector whose start point is P and 
end point is Q14, and P_Q23 denotes a vector whose start 
point is P and end point is Q23. 

In actuality, there will be hardly a problem if 
expression 15 given below is used in place of expression 
14 to calculate M1423act. 

M1423act = P_Ql*Flact+P_Q2*F2act 

+ P_Q3*F3act + P_Q4*F4act 

. . . Expression 15 

The right side of expression 15 is an expression for 
calculating the actual total floor reaction force moment 
Mtotalact acting about the desired total floor reaction 
force central point P from the translat ional force 



components Fn_act (n=l , 2 , 3 , 4 ) of the actual floor reaction 
forces of the first to the fourth nodes (leaf nodes) . 
Supplementally, in expression 14, the actual floor 
reaction force moment acting about the desired 14th node 
floor reaction force central point Q14 and the actual 
floor reaction force moment acting about the desired 23rd 
node floor reaction force central point Q23 are subtracted 
from the actual total floor reaction force moment 
Mtotalact acting about the desired total floor reaction 
force central point P. 

In general, an actual n-th node floor reaction force 
moment Mn_act of an arbitrary n-th node, which is a leaf 
node, is the actual floor reaction force moment of an n-th 
ground contact portion. Regarding an arbitrary n-th node, 
which is not a leaf node, the moment from the floor 
reaction forces of all child nodes thereof acting on the 
desired n-th node floor reaction force central point (the 
floor reaction forces of the child nodes here are, 
strictly speaking, the floor reaction forces acting on the 
desired floor reaction force central points of the child 
nodes) is referred to as an actual n-th node floor 
reaction force moment Mn_act. As in expression 14 and 
expression 15, there are two different definitions of an 
actual n-th node floor reaction force moment. One 
includes the actual floor reaction force moments of child 
nodes and the other does not include them; however, either 
of the definitions may be used. Especially when the 



responsiveness of feedback control for controlling the 
horizontal components of the actual floor reaction force 
moments of child nodes is high, the horizontal components 
of the actual floor reaction force moments of the child 
nodes immediately converge to zero, so that the behavior 
of the control of the actual floor reaction force of an n- 
th node does not change much when either of the 
definitions is used. 

Expression 16 shown below is a general expression 
for calculating an actual n-th node floor reaction force 
moment, which corresponds to expression 14, and expression 
17 is a general expression for calculating an actual n-th 
node floor reaction force moment, which corresponds to 
expression 15. In expression 16 and expression 17, Qn_Qm 
is a vector whose start point is Qn and end point is Qm. 
An actual floor reaction force moment Mm_act of an m-th 
node, which is a leaf node, is an actual floor reaction 
force moment of each ground contact portion detected by an 
actual floor reaction force detector. 

when me {set of numbers of child nodes of n-th node}, 
Mn_act=S (Qn_Qm*Fm_act) ... Expression 16 

when me {set of numbers of leaf nodes, which are 
descendants of n-th node}, 

Mn act=S(Qn Qm*Fm act+Mm act) ... Expression 17 
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Z in expressions 16 and 17 means the total sum 
regarding m. Supplementally, in the first embodiment, the 
actual floor reaction force moment about the desired floor 
reaction force central point of a leaf node (each ground 
5 contact portion) becomes zero; therefore, the right side 

of the above expression 15 does not include a component of 
Mm_act of expression 17. In a robot in which the postures 
of ground contact portions can be controlled, Mm_act of 
expression 17 generally does not become zero. 

10 The 1423rd node compensating angle 01423 may 

generally be determined by feedback control law or the 
like such that the difference between M1423act determined 
as described above and the 1423rd node compensating floor 
reaction force moment M1423dmd previously determined by 

15 the compensating total floor reaction force moment 

distributor 114a (M1423act-M1423dmd) approximates zero. 
For example, 01423 may be determined by, for example, 
multiplying the difference by a predetermined gain matrix 
(tertiary diagonal matrix) . 

20 However, in the present embodiment, the 1423rd node 

compensating angle 01423 about the axis in the direction 
of the aforesaid vector V1423 may be determined, so that 
01423 may be determined on the basis of the difference 
between a component M1423actv in the direction of the 

25 vector V1423 of M1423act and a component M1423dmdv in the 
direction of the vector V1423 of M1423dmd. And, at this 
time, in the present embodiment, M1423actv and M1423dmdv 
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are passed through a filter before determining 91423 on 
the basis of the difference therebetween in order to 
enhance the responsiveness and stability of the control of 
floor reaction forces. 
5 Specifically, the component M1423actv in the 

direction of the vector V1423 of M1423act determined as 
described above is extracted. This is obtained by the 
following expression 18 using a scalar product calculation 
of a vector. 

10 

M1423actv = M1423act • V1423 . . . Expression 18 

The processing for calculating M1423actv as 
described above is executed by a calculator indicated by a 

15 reference numeral 114k in Fig. 19. 

Next, the aforesaid M1423actv is passed through a 
low-pass filter 114i to obtain M1423actvf ilt . Furthermore, 
the component M1423dmdv in the V1423 direction of the 
aforesaid 1423rd node compensating floor reaction force 

20 moment M1423dmd is passed through a compensating filter 

114j to obtain Ml 42 3dmdvf il t . Incidentally, M1423dmdv is 
determined by the scalar product calculation of M1423dmd 
and V1423, as with the aforesaid expression 18. Then, the 
result obtained by subtracting M1423dmdvf ilt from 

25 M1423actvf ilt provides a component M1423errv in the 
direction of an error moment V1423. 

The aforesaid compensating filter 114j improves the 
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frequency response characteristic of transfer functions 
from M1423dmdv to an actual total floor reaction force 
moment in a control device. 

Lastly, the aforesaid 1423rd node compensating angle 
5 01423 is obtained by the calculation of the feedback 

control law (proportional control law in this case) of the 
following expression 19. Here, K1423 denotes a control 
gain, and it is normally set to a positive value. 

10 01423 = K1423*M1423errv ... Expression 19 

This means that the component M1423errv in direction of 
the error moment V1423 is multiplied by the control gain 
K1423 to obtain the 1423rd node compensating angle 01423. 

15 The processing of the compensating angle determiner 

(014 determiner) 114c in Fig. 17 will now be explained 
with reference to Fig. 20. If the translational force 
component Flact of the actual first node floor reaction 
force (the actual floor reaction force of the first ground 

20 contact portion 10) acts on a desired first node floor 
reaction force central point Ql, and the translational 
force component F4act of the actual fourth node floor 
reaction force (the actual floor reaction force of the 
fourth ground contact portion 10) acts on a desired fourth 

25 node floor reaction force central point Q4, then a moment 
M14act generated about the desired 14th node floor 
reaction force central point Q14 by the above 
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translational force components is determined according to 
the aforesaid expression 16, which is a general expression. 

More specifically, it is determined according to the 
following expression 20. 

5 

M14act = Q14_Ql*Flact+Q14_Q4*F4act . • • Expression 20 

where Q14_Q1 denotes a vector whose start point is Q14 and 
end point is Ql, and Q14_Q4 denotes a vector whose start 
10 point is Q14 and end point is Q4 . 

In actuality, for the reason described previously, 
there will be hardly a problem if the following expression 
21 (expression substantiating the above expression 17) is 
used in place of expression 20. 

15 

M14act = Q14_Ql*Flact+Q14_Q4*F4act+Mlact+M4act 

. . . Expression 21 

where Mlact denotes an actual first node floor reaction 
20 force moment and M4act denotes an actual fourth node floor 
reaction force moment. In the first embodiment, the 
distal portions of the legs #1 to #4 are provided with 
free joints (spherical joints 12); hence, Mlact and M4act 
are zero. 

25 Expression 21 is an expression for calculating the 

moment acting about the desired 14th node floor reaction 
force central point generated by the resultant force of 



- 157 - 



the actual floor reaction forces of all leaf nodes of the 
14th node. Incidentally, expression 20 subtracts the 
actual first node floor reaction force moment and the 
actual fourth node floor reaction force moment from the 
5 moment acting about the desired 14th floor reaction force 
central point generated by the resultant force of the 
actual floor reaction forces of all leaf nodes of the 14th 
node . 

The 14th node compensating angle 914 may be 
10 generally determined by the feedback control law or the 

like such that the difference between M14act determined as 
described above and the 14th node compensating floor 
reaction force moment M1423dmd previously determined by 
the compensating total floor reaction force moment 
15 distributor 114a (Ml 4act-Ml 4dmd) approximate zero. 

In the present embodiment, however, for the same 
reason as that in the case of 01423, 914 is determined on 
the basis of the difference between the component M14actv 
of M14act in the aforesaid direction of the vector V14 and 
20 the component M14dmdv of M14dmd in the direction of the 

vector V14, which have been respectively passed through a 
filter . 

More specifically, the component M14actv of M14act 
in the direction of the vector V14 determined as described 
25 above is extracted. This is obtained by expression 22 
that uses the scalar product calculation of vectors. 
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M14actv = M14act • V14 . . . Expression 22 

The processing for calculating M14actv as described 
above is carried out by a calculator indicated by a 
5 reference character 114k' in Fig. 20. 

Next, the aforesaid M14actv is passed through a low- 
pass filter 114i' to obtain M14actvfilt. Further, the 
component M14dmdv of the aforesaid 14th node compensating 
floor reaction force moment in the direction of V14 is 

10 passed through a compensating filter 114 j' to obtain 

M14dmdvfilt. Incidentally, M14dmdv is determined by the 
scalar product calculation of M14dmd and V14. Then, 
M14dmdvfilt is subtracted from M14actvfilt to obtain a 
component M14errv in the direction of an error moment V14. 

15 Incidentally, the compensating filter 1 14 j ' improves the 
frequency response characteristics of transfer functions 
from M14dmdv to actual total floor reaction force moments 
in a control device. 

Lastly, the aforesaid 14th node compensating angle 

20 014 is obtained by the calculation of the feedback control 
law (proportional control law in this case) of expression 
23 given below. Here, K14 denotes a control gain, which 
is normally set to a positive value. 

25 014 = K14*M14errv . . . Expression 23 

The processing of the compensating angle determiner 
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(023 determiner) 114d in Fig. 17 is the same as the 
processing of the 14th node compensating angle 014 
determiner 114c; therefore, detailed explanation thereof 
will be omitted here. The following provides an overview 
5 of the processing. A component M23actv of a moment M23act 
in the direction of a vector V23, the moment being 
generated about a desired 23rd node floor reaction force 
central point Q23 by the actual floor reaction forces of 
the child nodes of a 23rd node, is calculated on the basis 

10 of the aforesaid expression 16 or 17. Then, the 23rd node 

compensating angle 023 is calculated by the arithmetic 
processing of the feedback control law (proportional 
control law) from a component M23errv in the direction of 
the error moment V23 obtained by subtracting M23actvfilt, 

15 which is obtained by passing the above M23actv through a 
low-pass filter, from M23dmdvfilt obtained by passing 
M23dmdv of the aforesaid 23rd node compensating floor 
reaction force moment M23dmd in the direction of V23 
through a compensating filter. 

20 The processing of the compensating angle determiners 

114b to 114d determines the sets of the node compensating 
angles 01423, 014 and 023 such that the horizontal 
components of the actual moments Mact acting on the 
desired total floor reaction force central points P 

25 approximate the compensating total floor reaction force 
moment Mdmd. In the present embodiment, 01423 has been 
determined by the aforesaid expression 19; alternatively, 
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however, it may be determined on the basis of the 
difference between M1423act+M14act+M23act (the total sum 
of actual node floor reaction force moments) and M1423dmd 
or the difference between the total sum of actual node 
5 floor reaction force moments and M1423dmd, which have been 

respectively passed through a filter, in place of M1423err 
of the right side of expression 19. 

Supplementally, in the present embodiment, a node 
compensating floor reaction force moment has been 

10 determined without changing the desired node floor 

reaction force central point Qn of each node, the Qn being 
the point of action. Then, the difference between the 
node floor reaction force compensating moment (more 
precisely, the resultant force of the node compensating 

15 floor reaction force moment and the moment component of 
the desired node floor reaction force having Qn as its 
point of action) and an actual node floor reaction force 
moment having Qn as its point of action has been used as a 
control amount to determine a node compensating angle such 

20 that the control amount approximates zero. Instead of 
determining the node compensating angles as described 
above, the node compensating angles 01423, 614 and 023 may 
be determined as follows. On each n-th node 
(n=14, 23, 1423) having child nodes, a floor reaction force 

25 central point that causes the horizontal component of the 
moment of the actual node floor reaction force of the n-th 
node (the resultant force of the actual node floor 
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reaction forces of all child nodes of the n-th node) to 
become zero is determined as an actual n-th node floor 
reaction force central point. Alternatively, a floor 
reaction force central point that causes the horizontal 
5 component of a moment, which is obtained by subtracting 

the moment acting on the desired node floor reaction force 
central point of each child node due to the actual node 
floor reaction force of the child node from the moment of 
the actual node floor reaction force of an n-th node 

10 (n=14, 23, 1423) , to become zero is determined as an actual 

n-th node floor reaction force central point. For example, 
the actual 14th node floor reaction force central point 
related to the 14th node is determined as a point obtained 
by shifting, on the segment Q1Q4, the desired 14th node 

15 floor reaction force central point by the value obtained 
by dividing the horizontal component of M14act determined 
by the aforesaid expression 16 or 17 by the vertical 
component of the resultant force of Flact and F4act (the 
translational force component of an actual 14th node floor 

20 reaction force) . The same applies to the node floor 

reaction force central points of the 23rd node and the 
1423rd node. Then, the difference between the desired 
node floor reaction force central point of an n-th node 
(n=14, 23, 1423) and the actual n-th node floor reaction 

25 force central point determined as described above, or the 
difference between the values obtained by passing each of 
the above node floor reaction force central points through 
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a filter is defined as a control amount, and the node 
compensating angles 01423, 914, and 023 are determined on 
the basis of the control amount such that the control 
amount approximates zero (e.g., 61423, 614 and 623 are 
5 determined by multiplying the control amount by a certain 
gain) . 

The corrected desired ground contact portion 
position/posture calculator 114g in Fig. 17 obtains 
corrected desired ground contact portion position/posture 

10 by correcting the desired ground contact portion 

position/posture, which are the desired position and the 
desired posture of each ground contact portion 10, 
according to a technique for correcting the desired ground 
contact portion position/posture of the aforesaid 

15 hierarchical compliance operation (the technique explained 
with reference to Fig. 15 and Fig. 16) on the basis of the 
1423rd node compensating angle 61423, the 14th node 
compensating angle 614, and the 23rd node compensating 
angle 623. However, in the present embodiment, the distal 

20 portions of the legs #1 to #4 are provided with free 
joints (spherical joints 12), and the posture of each 
ground contact portion 10 cannot be intentionally changed; 
therefore, the corrected desired ground contact portion 
position/posture actually means the corrected desired 

25 ground contact portion position. 

Fig. 21 is a functional block diagram showing the 
processing of the aforesaid deformation compensation 
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amount calculator 114n in Fig. 17. As shown in Fig. 21, 
the deformation compensation amount calculator 114n 
determines deformation amounts En_mdf d (n=l , 2 , 3 , 4 ) , which 
are the deformation amounts of the legs #1 to #4 (the 
5 deformation amounts of the link mechanisms of the legs and 
the compliance mechanism 42), the deformation being 
expected to occur due to the corrected desired ground 
contact portion floor reaction forces Fn_refmdfd 
(n=l,2,3,4) of the ground contact portions 10 that are 

10 output from the compensating total floor reaction force 

moment distributor 114a (the desired ground contact 
portion floor reaction forces that have been corrected by 
adding the 1423rd node compensating floor reaction force 
moment M1423dmd, the 14th node compensating floor reaction 

15 force moment M14dmd, and the 23rd node compensating floor 
reaction force moment M23dmd to desired ground contact 
portion floor reaction forces) . The deformation amounts 
En_mdf d (n=l , 2 , 3 , 4 ) are determined by using a mechanism 
compliance model showing the relationship between the 

20 forces (or floor reaction forces) acting on the legs and 
the deformations of the legs. Then, the deformation 
compensation amount calculator 114n determines deformation 
compensation amounts En_cmpn (n=l , 2 , 3 , 4 ) for canceling the 
deformation amounts En_mdf d (n=l , 2 , 3 , 4 ) . The deformation 

25 compensation amount En_cmpn is determined by multiplying 
each deformation amount En_mdfd by (-1). 

The corrected desired ground contact portion 
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position/posture with deformation compensation calculator 
114h in Fig. 17 adds a further correction to the corrected 
desired ground contact portion position/posture of each 
ground contact portion 10 (the position/posture determined 
5 by the aforesaid corrected desired ground contact portion 
position/posture calculator 114g) so as to cancel the 
calculated deformation amount En_mdfd, thereby obtaining 
the corrected desired ground contact portion 
position/posture with deformation compensation of each 

10 ground contact portion 10. The corrected desired ground 
contact portion positions /postures with deformation 
compensation are determined by adding individually 
corresponding deformation compensation amounts En_cmpn to 
the corrected desired ground contact portion 

15 position/posture of the ground contact portions 10. 

For example, if a calculation result indicates that 
a corrected desired ground contact portion floor reaction 
force would cause the compliance mechanism 42 or the like 
of a leg corresponding to a certain ground contact portion 

20 10 to contract by z in the vertical direction, then the 
corrected desired ground contact portion floor reaction 
force is corrected so as to lower the desired position of 
the ground contact portion 10 by z. More specifically, 
the corrected desired ground contact portion 

25 position/posture with deformation compensation is 

calculated such that the position/posture when the ground 
contact surface (bottom surface) of the ground contact 
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portion 10 after deformation compensation is deformed 
under a desired ground contact portion floor reaction 
force agrees with the desired position/posture of the 
ground contact surface of the ground contact portion 
5 before the deformation compensation. Incidentally, 

detailed explanation thereof is explained in detail in 
Japanese Unexamined Patent Application Publication No. 
H10-277969. In the robot 1 of the present embodiment, the 
postures of the ground contact portions 10 cannot be 
10 controlled, so that the corrected desired ground contact 

portion position/posture with deformation compensation 
calculator 114h actually corrects the corrected desired 
ground contact portion positions of the ground contact 
portions 10. 

15 The deformation compensation described above is 

implemented by control for canceling in a feed-forward 
manner the shifts in actual ground contact portion 
position/posture caused by a deformation of the compliance 
mechanism 42 or the like. In comparison with a case where 

20 no such control is carried out, it is possible to enable 
the robot 1 to travel in a gait that is further closer to 
a desired gait. 

The above has given the details of the processing of 
the hierarchical compliance operation determiner 114. 

25 Based on the above, resuming the explanation of the 

flowchart in Fig. 9, compensating angles are determined as 
described above in S34. Fig. 22 is a flowchart showing a 
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generalized subroutine of the processing for determining 
the compensating angles. 

To explain with reference to the figure, first, the 
translational force components 
5 Fn_act (n=l, 2, 3, 4, 14, 23, 1423) of actual n-th node floor 

reaction forces are calculated on the basis of the actual 
floor reaction forces of the ground contact portions 10 
(the actual floor reaction forces obtained by the 
aforesaid actual floor reaction force detector 108). In 

10 this case, the translational force components 

Fn_act (n=l , 2 , 3 , 4 ) of the actual node floor reaction forces 
of the leaf nodes are the translational force components 
of the detected values of the actual floor reaction forces 
of the ground contact portions 10 by the aforesaid actual 

15 floor reaction force detector 108. Further, the 

translational force component Fn_act (n=14, 23, 1423) of the 
actual node floor reaction force of a node that is not a 
leaf node is the translational force component of the 
resultant force of the actual node floor reaction forces 

20 of the child nodes of the node, as described above. 

Subsequently, the processing proceeds to S102 to 
calculate an actual n-th node floor reaction force moment 
Mn_act (n=l, 2, 3, 4, 14, 23, 1423) . In the robot 1 of the 
first embodiment, the actual node floor reaction force 

25 moment Mn_act (n=l,2,3,4) of each leaf node is zero. 

Further, the actual node floor reaction force moment 

Mn act (n=14, 23, 1423) of each node that is not a leaf node 
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is calculated on the basis of the aforesaid expression 16 
or expression 17 from Fn_act (n=l , 2 , 3 , 4 ) obtained in S100 
and the desired node floor reaction force central point 
Qn (n=l, 2, 3, 4, 14,23, 1423) . 
5 Subsequently, the processing proceeds to S104 

wherein the n-th node compensating floor reaction force 
moment Mn_dmd (n=14, 23, 1423) is determined on the basis of 
the compensating total floor reaction force moment Mdmd 
determined by the aforesaid posture stabilization control 

10 calculator 104. This processing is carried out as 

described above by the aforesaid compensating total floor 
reaction force moment distributor 114a. 

Subsequently, the processing proceeds to S106 to 
determine the vectors V1423, V14 and V23 defined in the 

15 explanation of the hierarchical compliance operation and 
vectors U1423, U14 and U23 orthogonal thereto. In the 
first embodiment, however, the floor reaction force 
moments in the directions of the vectors U1423, U14 and 
U23 cannot be generated; therefore, it is unnecessary to 

20 determine U1423, U14 and U23. 

Supplementally, as in the second embodiment to be 
described hereinafter, if the number of child nodes of an 
n-th node is 3 or more, then Vn may be set in any 
direction as long as it does not suddenly change timewise; 

25 hence, the direction of Vn may be appropriately determined 
by, for example, setting it to the direction of the X axis 
of a supporting leg coordinate system or the direction of 



- 168 - 



the body of a robot. Further, Un is to be orthogonal to 
Vn. 

Subsequently, the processing proceeds to S108 to 
extract a component Mn_actv in the Vn direction and a 
5 component Mn_actu in the Un direction of an actual n-th 
node floor reaction force moment Mn_act (n=14, 23, 1423) . 
This may be accomplished by carrying out the scalar 
product calculation of Mn_act and Vn and Un . Incidentally, 
if the number of child nodes of an arbitrary n-th node 

10 that is not a leaf node is two or less, as in the first 

embodiment, then the component Mn_actu in the Un direction 
is zero. Hence, it is unnecessary to determine Mn_actu. 

Subsequently, the processing proceeds to S110 to 
extract a component Mn_dmdv in the Vn direction and a 

15 component Mn_dmdu in the Un direction of an n-th node 
compensating floor reaction force moment 
Mn_dmd (n=14, 23, 1423) . This may be accomplished by 
carrying out the scalar product calculation of Mn_dmd and 
Vn and Un . Incidentally, if the number of child nodes of 

20 an arbitrary n-th node that is not a leaf node is two or 
less, as in the first embodiment, then the component 
Mn_dmdu in the Un direction of the n-th node compensating 
floor reaction force moment Mn_dmd is set to zero. 
Alternatively, it is unnecessary to determine Mn_dmdu . 

25 Subsequently, the processing proceeds to S112 to 

determine a Vn component of an n-th node compensating 
angle 0n by multiplying the difference between a value 
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obtained by passing Mn_actv through a filter and a value 
obtained by passing Mn_dmdv through a filter by a gain Kn 
(more generally, according to the feedback control law 
from the difference) . In the first embodiment, this 
5 processing is carried out as described above on the 14th 
node, the 23rd node, and the 1423rd node by the aforesaid 
compensating angle determiners 114b, 114c and 114d. 

Subsequently, the processing proceeds to S114 to 
determine a Un component of an n-th node compensating 

10 angle 6n by multiplying the difference between a value 

obtained by passing Mn_actu through a filter and a value 
obtained by passing Mn_dmdu through a filter by the gain 
Kn (more generally, according to the feedback control law 
from the difference) . However, if the number of child 

15 nodes of an arbitrary n-th node that is not a leaf node is 
two or less, as in the first embodiment, then an n-th node 
compensating angle U component is set to zero. 
Alternatively, it is unnecessary to carry out the 
processing of S114. 

20 The above is the subroutine processing of S34 in Fig. 

9. Supplementally, the processing of S106 to S114 may be 
regarded as the processing for determining an n-th node 
compensating angle such that the actual n-th node floor 
reaction force moment acting on a desired n-th node floor 

25 reaction force central point converges to an n-th node 

compensating floor reaction force moment (more precisely, 
the resultant force of the n-th node compensating floor 
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reaction force moment and the desired node floor reaction 
force moment acting on the desired n-th node floor 
reaction force central point) . 

Subsequently, the processing proceeds to S36 of the 
flowchart of Fig. 9 to calculate the aforesaid deformation 
compensation amount. This processing is carried out by 
the aforesaid deformation compensation amount calculator 
114n as described above. 

Subsequently, the processing proceeds to S38 to 
correct a desired ground contact portion position/posture 
on the basis of the compensating angle determined in S34 
and to further correct it on the basis of the deformation 
compensation amount determined in S36, thereby obtaining 
the corrected desired ground contact portion 
position/posture with deformation compensation of each 
ground contact portion 10. In the first embodiment, the 
corrected desired ground contact portion positions of the 
ground contact portions 10 are determined on the basis of 
the compensating angles 91423, 914, and 923 as described 
above (as explained with reference to the aforesaid 15 and 
Fig. 16) by the corrected desired ground contact portion 
position/posture calculator 114g. Then, the determined 
corrected desired ground contact portion positions are 
further corrected by the corrected desired ground contact 
portion position/posture with deformation compensation 
calculator 114h on the basis of the aforesaid deformation 
compensation amount En_cmpn (n=l , 2 , 3 , 4 ) , as described above, 
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thereby obtaining the corrected desired ground contact 
portion positions with deformation compensations of the 
ground contact portions 10. 

The processing from S32 to S38 in Fig. 9 explained 
5 above is the processing of the hierarchical compliance 
operation determiner 114. 

Subsequently, the processing proceeds to S40 to 
calculate the joint displacement command of the robot 1 
from the desired body position/posture and the corrected 

10 ground contact portion position/posture with deformation 
compensation (the corrected ground contact portion 
position with a deformation compensation in the first 
embodiment) . This processing is carried out as described 
above by the aforesaid robot geometric model 110. 

15 Subsequently, the processing proceeds to S42 to make 

an actual joint displacement follow the joint displacement 
command. This follow-up control (servo control) is 
carried out by the aforesaid displacement controller 112. 
Subsequently, the processing proceeds to S44 to 

20 update time by At (the arithmetic processing cycle of the 
control device 50), and returns to S14 to repeat the 
processing described above. 

Owing to the hierarchical compliance operation as in 
the first embodiment explained above, the control of each 

25 node floor reaction force hardly interferes with each 

other, thus allowing the node floor reaction forces to be 
controlled easily and properly also in a mobile robot 
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having three or more ground contact portions. This 
restrains control interference and also restrains the 
actual floor reaction force of each node from deviating 
from a desirable value or from vibrating. Thus, even if a 
5 floor surface has not only an undulation or tilt over a 

large area thereof but also unexpected changes in the 
floor configuration, including local projections or 
depressions or slopes, floor reaction forces acting on a 
legged mobile robot can be properly controlled without 

10 being influenced by them much. Moreover, control for 

stabilizing the posture of a mobile robot can be easily 
accomplished and the landing shocks to the mobile robot 
can be reduced, thus allowing the ground contact 
properties of the mobile robot to be enhanced and also 

15 preventing the mobile robot from slipping or spinning when 
it travels. Furthermore, the loads of the actuators of 
the mobile robot can be reduced. Hence, the floor 
reaction forces of ground contact portions can be properly 
controlled, so that high posture stability can be obtained. 

20 To supplement the advantages contributing to the 

stabilization of the posture of a robot, when the entire 
robot inclines from a state in which the robot is walking 
as expected on an expected floor surface, the relationship 
between an inclination angle error Gberr (Gberrx, 0berry) 

25 and an increasing amount AM of the moment horizontal 
component about a desired total floor reaction force 
central point generated in response thereto is preferably 
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a proportional relationship. If not, it is still 
preferred that expression 24 given below holds for a 
certain rotational matrix T and a certain diagonal matrix 
diag(a,b). Incidentally, T, diag(a,b) are secondary 
square matrixes. 

T*AM=diag (a, b) *T*0berr ... Expression 24 

If these relationships are not satisfied, then the 
inclination angle error 0berr will not linearly converge 
when the robot restores its posture from the inclined 
state, and a precession movement may occur. For instance, 
in a state wherein the body of a robot inclines forward, 
the force (restoring force) to fall sideways other than 
the restoring force for returning backward excessively 
acts, and the inclination angle error Gberr does not 
linearly return to zero. Instead, a restoring force acts 
toward back sideways and the inclination angle error Gberr 
spirally converges to zero. 

For the same reason as that described above, in the 
compliance control, the relationship between a changing 
rate d6berr/dt of the inclination angle error Gberr of the 
entire robot and an increasing amount AM_d of the moment 
generated in response thereto is also preferably a 
proportional relationship. If not, it is still preferred 
that expression 25 given below holds for a certain 
rotational matrix T and a certain diagonal matrix 
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diag(e,f). Incidentally, T, diag(a,b) are secondary 
square matrixes. 



T*AM_d=diag (e, f ) *T*d9berr/dt ... Expression 25 

In general, if compliance control is independently 
carried out on each leg of a robot, these relationships 
may not be satisfied and a precession movement may take 
place. In the hierarchical compliance control shown in 
the first embodiment, the relationships of the aforesaid 
expressions 24 and 25 can be satisfied, so that the 
convergence of the posture control of the robot is high 
and it is possible to prevent oscillation or vibration. 



In the aforesaid first embodiment, the desired 
ground contact portion positions have been compensated 
(corrected) so as to rotationally move about node floor 
reaction force central points without changing the 
postures of the ground contact portions (without 
controlling the postures) , thereby correcting the relative 
heights of the ground contact portions 10 from the 
relative heights of the desired ground contact portion 
positions. Alternatively, however, only the heights of 
the ground contact portions 10 may be corrected by moving 
the desired ground contact portion positions only in the 
vertical direction. Specifically, a desired ground 
contact portion position is corrected according to the 
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following procedure . 

First, by the following expressions 26 and 27, a 
vertical position correction amount Z14 of a desired 14th 
node floor reaction force central point and a vertical 
position correction amount Z23 of a desired 23rd node 
floor reaction force central point are determined. 

Z14=-PQ14*91423 ... Expression 26 

Z23=PQ23*01423 . . . Expression 27 

Here, note that the value determined by the aforesaid 
expression 19 is substituted into 01423. 

Next, the vertical position correction amounts 
Zn (n=l , 2 , 3 , 4 ) of the desired floor reaction force central 
points of the ground contact portions (the desired node 
floor reaction force central points of leaf nodes) are 
determined according to the following expressions. 

Z1=-Q14Q1*014+Z14 . . . Expression 28 

Z4=Q14Q4*914+Z14 ... Expression 29 

Z2=-Q23Q2*023+Z23 . . . Expression 30 

Z3=Q23Q3*023+Z23 . . . Expression 31 

Here, note that the value determined by the aforesaid 
expression 23 is substituted into 014, and the value 
determined in the same manner as that for 014 is 
substituted into 023. 

The corrected desired ground contact portion 
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positions are obtained by adding Zl, Z2, Z3 and Z4 
determined as described above to the desired ground 
contact portion positions in the vertical direction. 

Further, in the aforesaid first embodiment, the 
5 ground contact portions 10 have been hierarchized as shown 
in the aforesaid Fig. 6; however, the hierarchical 
structure does not necessarily have to be decided to be 
one hierarchical structure beforehand. For example, the 
hierarchical structure may be changed according to the 

10 travel mode (the motion mode of legs when traveling) of 

the robot 1, including trotting or galloping. For 
instance, the ground contact portions 10 may be 
hierarchized as shown in Fig. 23. Fig. 23 illustrates, as 
in the aforesaid Fig. 3(b), an example wherein the pair of 

15 the first ground contact portion 10 and the second ground 
contact portion 10 is defined as a 12th node and the pair 
of the third ground contact portion 10 and the fourth 
ground contact portion 10 is defined as a 34th node in a 
period during which all legs #1 to #4 of the robot 1 are 

20 all supporting legs. In this example, the desired node 
floor reaction force central points 
Qn (n=l, 2, 3, 4, 12, 34, 1234) of the nodes are set as 
illustrated. With this arrangement, the aforesaid 
compliance operation and the estimation of a floor 

25 configuration, which will be discussed later, can be 
performed more accurately in some cases. 
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[ Second Embodiment ] 

The following will explain a second embodiment of 
the present invention with reference to the aforesaid Fig. 
1 and Fig. 24 to Fig. 34. Referring to Fig. 1, the 
5 explanation will be focused on the aspects of a robot 1 of 
the second embodiment that are different from the robot of 
the first embodiment. The robot 1 of the second 
embodiment is provided with, in addition to the first to 
the fourth legs #1 to #4, a fifth leg #5 and a sixth leg 

10 #6 having the same structures as those of the legs #1 to 

#4. This means that the robot 1 of the second embodiment 
is a six-legged robot. The fifth leg #5 is behind the 
third leg #3 and extended from the right side of the body 
24 of the robot 1, and the sixth leg #6 is behind the 

15 fourth leg #4 and extended from the left side of the body 
24 of the robot 1. The rest of the mechanical structure 
of the robot 1 is the same as that of the first embodiment, 
so that the like reference numerals as those of the first 
embodiment will be assigned and the explanation thereof 

20 will be omitted. 

The basic concept of the technique of the 
hierarchical compliance control of the robot 1 (six-legged 
robot) of the second embodiment is the same as that of the 
first embodiment. However, the hierarchical compliance 

25 control of the second embodiment differs from that of the 
first embodiment in that there is a node having three 
child nodes and control processing is expanded to handle 



- 178 - 



them. 

The following will explain the control processing of 
the robot 1 of the second embodiment, focusing mainly on 
the different aspects. Regarding the reference numerals 
5 and terms used in the explanation of the second embodiment, 
the same reference numerals and terms as those in the 
first embodiment will be used for those that have the 
equivalent meanings as those in the first embodiment, and 
detailed explanation thereof will be omitted. 

10 Fig. 24 is a diagram for explaining the hierarchical 

structure in the second embodiment, and it is a diagram 
corresponding to Fig. 3(b) in the first embodiment. As 
shown in Fig. 24, in the second embodiment, the six 
individual ground contact portions 10 are defined as leaf 

15 nodes (the first to the sixth nodes), and the set of all 
the six ground contact portions 10 is defined as a root 
node (the 145236th node) . In addition, the set of the 
first, the fourth, and the fifth ground contact portions 
10, which are the ground contact portions of the first leg 

20 #1, the fourth leg #4, and the fifth leg #5 is defined as 
a 145th node, and the set of the second, the third, and 
the sixth ground contact portions 10, which are the ground 
contact portions of the second leg #2, the third leg #3, 
and the sixth leg #6 is defined as a 236th node. In other 

25 words, the 145th node is an intermediate node having the 
first, the fourth, and the fifth nodes (three leaf nodes) 
as child nodes, and the 236th node is an intermediate node 
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having the second, the third, and the sixth node (three 
leaf nodes) as child nodes. 

In the second embodiment, for example, the set of 
the three ground contact portions 10 of the 145th node and 
5 the set of the three ground contact portions 10 of the 

236th node are alternately lifted and landed to move the 
robot 1. Fig. 24 shows the state wherein both sets are 
landed (the state wherein both sets are supporting legs) . 
The triangles with the reference marks Qn (n=l, 2, 3, 4, 5, 6) 

10 in the figure correspond to the positions of the ground 

contact portions 10. 

Incidentally, Qn (n=l , 2 , 3 , 4 , 5 , 6) denotes the desired 
floor reaction force central point of each of the first to 
the sixth ground contact portions 10, which are leaf nodes 

15 (desired node floor reaction force central points), Q145 

and Q236 denote the desired floor reaction force central 
points of the 145th node and the 236th node, respectively 
(desired node floor reaction force central points) , and P 
denotes the desired total floor reaction force central 

20 point (= desired ZMP) as the desired floor reaction force 
central point (desired node floor reaction force central 
point) Q145236 of the root node (the 145236th node) . As 
with the first embodiment, Qn (n=l, 2, 3, 4, 5, 6) agrees with 
the central point of each corresponding ground contact 

25 portion 10 . 

The overall functional construction of a control 
device 50 in the second embodiment is the same as that 
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shown in Fig. 2 explained in conjunction with the 
aforesaid first embodiment. 

In this case, a gait generating device 100 in the 
second embodiment determines and outputs desired motion 
trajectories (a desired ground contact portion trajectory 
and a desired body position/posture trajectory) of the 
robot 1 and desired floor reaction force trajectories (a 
desired total floor reaction force central point 
trajectory and a desired total floor reaction force 
trajectory), as with that in the first embodiment. In the 
second embodiment, however, the desired ground contact 
portion trajectory is the trajectory of the desired ground 
contact portion position of each of the six ground contact 
portions 10. If the ground contact portions are provided 
such that their postures are controllable, then the 
trajectory of desired ground contact portion postures is 
also included in the desired ground contact portion 
trajectory. Further, the desired total floor reaction 
force central point trajectories are determined according 
to the motion modes of the legs #1 to #6 (especially the 
positions at which supporting legs are expected to land) 
in the second embodiment such that they continuously move 
while existing in a range, in which ZMPs can exist, at 
positions not excessively close to the boundaries of the 
range (e.g., at an approximately central position of the 
range wherein a ZMP can exist) . 

A desired floor reaction force distributor 102 in 
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the second embodiment determines desired node floor 
reaction force central points, the weights of nodes, and 
desired node floor reaction forces such that the following 
conditions A' ) to F' ) are satisfied, as with the first 
embodiment . 

A' ) The desired node floor reaction force central point 
Qn (n=l, 2, 3, 4, 5, 6) of each leaf node agrees with the 
central point of the ground contact portion 10 
corresponding to the leaf node. More generally, 
Qn (n=l, 2, 3, 4, 5, 6) is determined according to a desired 
gait (a desired motion, such as a desired ground contact 
portion trajectory). For example, if the desired floor 
reaction force central point of each ground contact 
portion 10 is determined by the gait generating device 100, 
then the desired node floor reaction force central point 
Qn (n=l, 2, 3, 4, 5, 6) may be determined on the basis of the 
desired floor reaction force determined by the gait 
generating device 100. 

B' ) The desired node floor reaction force central point of 
the root node agrees with a desired total floor reaction 
force central point P. 

C ) The desired node floor reaction force central point Qn 
of an arbitrary n-th node (n=145, 236, 145236) having child 
nodes will be a weighted average point of the desired node 
floor reaction force central points of the child nodes of 
the n-th node. More specifically, a desired node floor 
reaction force central point Q145 of a 145th node provides 
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the internally dividing point of a triangle having, as its 
apexes, desired node floor reaction force central points 
Ql, Q4 and Q5 of the first, the fourth, and the fifth 
nodes, which are the child nodes (leaf nodes) thereof 
5 (points on a boundary of the triangle being included) , and 

a desired node floor reaction force central point Q236 of 
a 236th node provides the internally dividing point of a 
triangle having, as its apexes, desired node floor 
reaction force central points Q2, Q3 and Q6 of the second, 

10 the third, and the sixth nodes, which are the child nodes 

(leaf nodes) thereof (points on a boundary of the triangle 
being included) . Further, a desired node floor reaction 
force central point Q145236 (= desired total floor 
reaction force central point P) of a 145236th node (root 

15 node) provides an internally dividing point of a segment 
connecting the desired node floor reaction force central 
points Q145 and Q236 of the 145th node and the 236th node, 
which are the child nodes (intermediate nodes) thereof. 
D' ) The desired node floor reaction force Fn of an 

20 arbitrary n-th node (n=145, 236, 145236) having child nodes 

agrees with the sum (resultant force) of the desired node 
floor reaction forces of all child nodes of the n-th node, 
and the desired node floor reaction force F145236 of the 
root node (the 145236th node) agrees with the desired 

25 total floor reaction force Ftotalref . Alternatively, the 
desired node floor reaction force 

Fn (n=l, 2, 3, 4, 5, 6, 145, 236, 145236) of each node has the 
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relationship with the weight of each node indicated by the 
aforesaid expression 4a or 4b. 

E' ) The desired node floor reaction force of a leaf node 
associated with the ground contact portion 10 not in 
5 contact with the ground is zero. 

F' ) The desired node floor reaction force central point, 
the weight, and the desired node floor reaction force of 
each node (n-th node (n=l, 2, 3, 4, 145, 236, 145236) ) 
continuously change . 
10 G' ) The weight of a leaf node corresponding to the ground 
contact portion 10 in a no-contact-with-ground state or 
the weight of any one of the ancestor nodes of the leaf 
node is zero. 

The weight of the root node has been set to for the 

15 sake of convenience, as with the aforesaid first embodiment. 

The processing of a posture error calculator 103 and 
a posture stabilization control calculator 104 in the 
second embodiment is the same as that in the first 
embodiment; a compensating total floor reaction force 
2 0 moment Mdmd (Mdmdx, Mdmdy) is determined as explained in 
the first embodiment. 

An actual floor reaction force detector 108 in the 
second embodiment, as that in the first embodiment, 
detects the actual floor reaction forces acting on the 
25 ground contact portions 10 (the six ground contact 

portions in the present embodiment) from the outputs of 
six-axis force sensors 34 provided on the legs #1 to #6 
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and converts them into actual floor reaction forces 
represented by a supporting leg coordinate system (the 
global coordinate system shown in Fig. 1, which is fixed 
to a floor) . 

5 Primarily on the basis of the final desired 

trajectories of ground contact portion positions and 
desired body position/posture, a robot geometric model 
(inverse kinematics calculator) 110 in the second 
embodiment calculates joint displacement commands of the 

10 robot 1 that satisfy them by inverse kinematics 

calculation, as that in the first embodiment. 

Further, a displacement controller 112 in the second 
embodiment controls actuators (not shown) of the joints 14 
and 15 of the robot 1 so as to make actual joint 

15 displacements follow the aforesaid joint displacement 
commands, as that in the first embodiment. 

Further, a hierarchical compliance operation 
determiner 114 in the second embodiment corrects the 
desired ground contact portion trajectories of the ground 

20 contact portions 10 so as to satisfy the aforesaid 

requirements 1) and 2) as much as possible, as that in the 
first embodiment. The present embodiment, however, has 
intermediate nodes, each having three child nodes, so that 
the specific processing of the hierarchical compliance 

25 operation determiner 114 is somewhat more complicated than 
that in the first embodiment. If a robot is constructed 
such that the postures of the ground contact portions 10 
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are controllable, then the hierarchical compliance 
operation determiner 114 should correct the desired ground 
contact portion trajectories of the ground contact 
portions 10 to also satisfy the aforesaid requirement 3) 
5 as much as possible. 

Fig. 25 is a block diagram showing the functions of 
the hierarchical compliance operation determiner 114 of 
the second embodiment, and it corresponds to Fig. 17 in 
the first embodiment. Referring to Fig. 25, the 

10 hierarchical compliance operation determiner 114 of the 
second embodiment is equipped with, as its components 
(functional means) , a compensating total floor reaction 
force moment distributor 114a, compensating angle 
determiners 114b, 114c and 114d, a corrected desired 

15 ground contact portion position/posture calculator 114g, a 
deformation compensation amount calculator 114n, and a 
corrected desired ground contact portion position/posture 
with deformation compensation calculator 114h, as with the 
first embodiment. Incidentally, in the second embodiment, 

20 compensating angles include a 145236th compensating angle 
0145236, a 145th compensating angle 0145, and a 236th 
compensating angle 0236 related to the 145236th node, the 
145th node, and the 236th node, respectively, and the 
compensating angle determiners 114b, 114c, and 114d 

25 determine 0145236, 0145, and 0236, respectively. 

The following will explain the processing of the 
hierarchical compliance operation determiner 114 in the 
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second embodiment, focusing mainly on the aspects 
different from the first embodiment. 

The hierarchical compliance operation determiner 114 
in the second embodiment, as that in the first embodiment, 
determines the translational force component and the 
moment component of the desired node floor reaction force 
of each node primarily on the basis of an output of the 
desired floor reaction force distributor 102, and also 
determines the translational force component and the 
moment component of the actual node floor reaction force 
of each node on the basis of an output of the actual floor 
reaction force detector 108. 

More specifically, referring to Fig. 26, a 
translational force component Fn_ref (n=l , 2 , 3 , 4 , 5 , 6 ) of the 
desired node floor reaction force of each leaf node is 
identical to the translational force component of the 
desired node floor reaction force determined by the 
desired floor reaction force distributor 102, and a 
translational force component F145236ref of the desired 
node floor reaction force of the root node is identical to 
a translational force component Ftotalref of the desired 
total floor reaction force determined by the gait 
generating device 100. Further, a translational force 
component Fn_ref (n=l 4 5 , 2 3 6 ) of a desired node floor 
reaction force of an intermediate node other than leaf 
nodes and the root node is determined to be the 
translational force component of the resultant force of 
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the desired node floor reaction forces of the child nodes 
of the intermediate node (F145ref =Flref +F4ref +F5ref , 
F236ref =F2ref +F3ref +F6ref ) . In this case, the parent node 
of the intermediate node is the root node, so that 
5 F145ref+F236ref=Ftotalref . Incidentally, Fig. 26 

illustrates the translational force component Fn_ref of 
the desired node floor reaction force of each node in a 
state wherein all the ground contact portions 10 of the 
robot 1 in the second embodiment are in contact with the 

10 ground. 

The moment component of the desired node floor 
reaction force of node (more precisely, the moment 
component of the desired node floor reaction force having 
the desired node floor reaction force central point of the 

15 node as its point of action) is always set to zero. 

Referring to Fig. 30, a translational force 
component Fn_act (n=l , 2 , 3 , 4 , 5 , 6) of the actual node floor 
reaction force of each leaf node is identical to the 
translational force component of the actual floor reaction 

20 force of each ground contact portion 10 detected by the 
actual floor reaction force detector 108. Further, a 
translational force component Fn_act (n=145, 236, 145236) of 
the actual node floor reaction force of each node having 
child nodes is determined to be the translational force 

25 component of the resultant force of the actual node floor 

reaction forces of the child nodes of the node. Therefore, 
F14 5act=Flact+F4act+F5act, F2 3 6act=F2act+F3act+F6act, 



F145236act (=Ftotalact) =F1 4 5act+F2 3 6act . Fig. 30 
illustrates the translat ional force component Fn_act of 
the actual node floor reaction force of each node in the 
state wherein all the ground contact portions 10 of the 
robot 1 in the second embodiment are in contact with the 
ground . 

Further, referring to Fig. 31, a moment component of 
the actual node floor reaction force of each leaf node (a 
moment component having the desired node floor reaction 
force central point of the leaf node as its point of 
action) Mn_act (n=l, 2, 3, 4, 5, 6) is basically identical to 
the moment component of the actual floor reaction force of 
each ground contact portion 10 detected by the actual 
floor reaction force detector 108. In the present 
embodiment, however, no actual moment occurs at the 
central point of each ground contact portion 10, i.e., the 
desired floor reaction force central point of the ground 
contact portion 10; therefore, the moment component of the 
actual node floor reaction force of each leaf node is set 
to zero. Further, regarding the moment component Mn_act 
of the actual node floor reaction force of each n-th node 
(n=145, 236, 145236) that has child nodes, the resultant 
force of the actual node floor reaction forces of the 
child nodes of the n-th node is basically determined to be 
the moment component (this generally does not become zero) 
acting on the desired node floor reaction force central 
point of the n-th node. 
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The compensating total floor reaction force moment 
distributor 114a in the second embodiment distributes the 
aforesaid compensating total floor reaction force moment 
Mdmd the aforesaid compensating total floor reaction force 
5 moment Mdmd (Mdmdx, Mdmdy) to a 145236th node compensating 
floor reaction force moment M145236dmd, a 145th node 
compensating floor reaction force moment M145dmd, and a 
236th node compensating floor reaction force moment 
M2 3 6dmd. 

10 The 145236th node compensating floor reaction force 

moment M1423dmd is the desired value of the moment to be 
generated about a desired total floor reaction force 
central point P (desired ZMP) by the translational force 
component of the floor reaction force of each ground 

15 contact portion 10 generated by manipulating the 145236th 
compensating angle 0145236 (by rotating the set of the 
first, the fourth, and the fifth ground contact portions 
and the set of the second, the third, and the fifth ground 
contact portions about a desired total floor reaction 

20 force central point P(=Q145236) by 9145236). 

The 145th node compensating floor reaction force 
moment M145dmd is the desired value of the moment to be 
generated about a desired 145th node floor reaction force 
central point by the translational force component of the 

25 floor reaction force of each ground contact portion 10 

(specifically, the first, the fourth, and the fifth ground 
contact portions) generated by manipulating the 145th 
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compensating angle 0145 (by rotating the first, the fourth, 
and the fifth ground contact portions 10 belonging to the 
145th node about a desired 145th node floor reaction force 
central point Q145 by 0145) . 
5 The 236th node compensating floor reaction force 

moment M236dmd is the desired value of the moment to be 
generated about a desired 236th node floor reaction force 
central point by the translational force component of the 
floor reaction force of each ground contact portion 10 

10 (specifically, the second, the third, and the sixth ground 

contact portions) generated by manipulating the 236th 
compensating angle 0236 (by rotating the second, the third, 
and the sixth ground contact portions 10 belonging to the 
236th node about a desired 236th node floor reaction force 

15 central point Q236 by 0236) . 

In the present embodiment, as with the first 
embodiment, the posture of the robot 1 about the vertical 
axis is not controlled (because the component of the 
compensating total floor reaction force moment Mdmd about 

20 the vertical axis is zero) , so that M145236dmd, M145dmd, 

and M236dmd are all moments (horizontal vectors) whose 
components about the vertical axis are zero, and the 
compensating angles 0145236, 0145, and 0236 are rotational 
angles about the horizontal axis. In particular, 

25 M145236dmd is the moment about the horizontal axis 
perpendicular to a segment Q145Q236. 

These node compensating floor reaction force moments 
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M145236dmd, M145dmd, and M236dmd are basically determined 
such that the following conditions 11) and 12) are 
satisfied . 



5 11) On the 145th node, the 236th node, and the 145236th 

node, as defined in the aforesaid first embodiment, when 
corrected desired node floor reaction force central points 
Q145mdfd, Q236mdfd, and Pmdfd (=Q145236mdf d) that satisfy 
the relational expressions of the following expressions 7a 
10 to 9a are introduced, these Q145mdfd, Q236mdfd, and Pmdfd 

exist in their respective predetermined existence 
permissible range . 



M145236dmd= (Pmdf d-P) *Ftotalref ... Expression 7a 

15 M145dmd= (Q145mdf d-Q145) *F145ref ... Expression 8a 

M236dmd= (Q236mdf d-Q236) *F236ref ... Expression 9a 



The existence permissible ranges of Q145mdfd, 
Q236mdfd, and Pmdfd are set, for example, as shown in Fig. 

20 29(a) in a state wherein all the ground contact portions 
10 of the robot 1 of the second embodiment are in contact 
with the ground. More specifically, the existence 
permissible range of Q145mdfd is the region on the 
triangle in the bold line in the figure (the sides of and 

25 the region in the triangle) , and this is the region set in 
the triangle having, as its apexes, the desired node floor 
reaction force central points Ql, Q4, and Q5 of the child 
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nodes of the 145th node such that it is not excessively 
close to the boundary of the triangle Q1Q4Q4 . The 
existence permissible range of Q236mdfd is similar to the 
above. Further, the existence permissible range of Pmdfd 
5 is the region on the segment in bold line in the figure, 

and this is the region set on a segment Q145Q236 
connecting the desired floor reaction force central points 
Q145 and Q236 of the child nodes of the 145236th node 
(root node) such that it is not excessively close to the 
10 end points of the segment Q145Q236. 

12) Mdmd=M14 52 3 6dmd+M14 5dmd+M2 3 6dmd is substantially 
satisfied . 



Further, in the present embodiment, the root node 
15 (the 145236th node) has two child nodes, so that 

M145236dmd is limited to a vector in the same direction as 
that of a horizontal unit vector (this being denoted by 
V145236) orthogonal to the segment Q145Q236, as with each 
node compensating floor reaction force moment in the 
20 aforesaid first embodiment. Hence, in the present 
embodiment, M14 52 3 6dmd, M14 5dmd, and M2 3 6dmd are 
determined such that they satisfy the following condition 
13) . 



25 



13) The component of M14 52 3 6dmd+M14 5dmd+M2 3 6dmd in the 
direction of a vector V145236 takes a value close to the 
component of Mdmd in the direction of the vector V145236 
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as much as possible. 

M145236dmd, M145dmd, and M236dmd satisfying these 
conditions 11) to 13) are determined, for example, as 
5 follows. First, M145236dmd is determined to be the 

component of Mdmd in the V145236 direction. However, if 
the corrected desired node floor reaction force central 
point Pmdfd determined by the aforesaid 7a does not fall 
within its existence permissible range, then M145236dmd is 

10 corrected such that Pmdfd becomes a point of a boundary of 

the existence permissible range. Subsequently, Mdmdl45 
and Mdmd236 are determined such that the vector obtained 
by subtracting M145236dmd determined as described above 
from Mdmd substantially agrees with the sum of Mdmdl45 and 

15 Mdmd2 3 6, and the component of Mdmdl4 5+Mdmd2 3 in the 

V145236 direction is close to the V145236 component of 
Mdmd-Mdmdl4 52 3 6 as much as possible and also satisfies the 
aforesaid condition 11). In this case, Mdmdl45 and 
Mdmd236 are vectors that are parallel to each other. 

20 Examples of M145236dmd, M145dmd, and M236dmd 

determined as described above are shown in Fig. 29(b). 
Supplementally, M145236dmd is the horizontal vector 
perpendicular to the segment Q145Q236 as described above. 
If the posture of the robot 1 about the vertical 

25 axis is also controlled, the vertical components of 

M145236dmd, M145dmd, and M236dmd may be also determined. 

Compensating angle determiners 114b to 114d in the 
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second embodiment basically determine node compensating 
angles 0145236, 6145, and 0236 on the basis of the 
difference between the node compensating floor reaction 
force moment and the actual node floor reaction force 
5 moment (the moment having a desired node floor reaction 
force central point as the point of action) of each n-th 
node (n=145236, 145, 236) such that the difference 
approximates zero. The examples are shown in Fig. 30 and 
Fig. 31. In this case, in the present embodiment, 0145 is 

10 the angle of rotation in the same direction as the 

difference M145act-M145dmd and about an axis that passes 
the desired 145th node floor reaction force central point 
Q145, as shown in Fig. 30, and 0236 is the angle of 
rotation in the same direction as the difference M236act- 

15 M236dmd and about an axis that passes the desired 236th 

node floor reaction force central point Q236, as shown in 
Fig. 30. Further, 0145236 is the angle of rotation in the 
same direction as the difference Ml 4 52 3 6act-Ml 4 52 3 6dmd 
(the horizontal direction perpendicular to the segment 

20 Q145Q236) and about an axis that passes the desired total 
floor reaction force central point P, as shown in Fig. 31. 

However, in the present embodiment also, as with the 
first embodiment, the node compensating angles 0145236, 
0145, and 0236 are determined on the basis of the 

25 difference between the node compensating floor reaction 
force moment of an n-th node (n=145236, 145, 236) that has 
been passed through a filter and the actual node floor 
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reaction force moment that has been passed through a 
filter . 

Fig. 32 is a block diagram showing the functions of 
the compensating angle determiner 114b (9145236 
5 determiner) that determines the node compensating angle 

0145236 as described above, and Fig. 33 is a block diagram 
showing the functions of the compensating angle determiner 
114c (0145 determiner) that determines the node 
compensating angle 0145 as described above. The 
10 processing of the compensating angle determiner 114d (0236 
determiner) is the same as the processing of the 0145 
determiner 114b, so that it will neither be explained nor 
shown . 

The compensating angle determiner (0145236 
15 determiner) 114b first determines the moment M145236act 
generated about the desired total floor reaction force 
central point P (the desired 145236th node floor reaction 
force central point) according to the aforesaid expression 
16 or 17 if the translat ional force component 
20 (Flact+F4act+F5act ) of the resultant force of actual first, 

fourth, and fifth node floor reaction forces acts on the 
desired 145th node floor reaction force central point Q145, 
and the translational force component (F2act+F3act+F6act ) 
of the resultant force of actual second, third, and sixth 
25 node floor reaction forces acts on the desired 236th node 
floor reaction force central point Q236. Then, a 
component M145236actv of the determined M145236act in the 
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direction of a vector V145236 is determined by scalar 
product calculation. Here, the vector V145236 is a 
horizontal unit vector that is perpendicular to the 
segment Q145Q236. Regarding the 145236th node, it is 
5 unnecessary to determine the component of M145236act in a 
vector U145236 direction because the positions of the 
desired floor reaction force central points of the child 
nodes (the 145th node and the 236th node) cannot be 
manipulated about the axis in the direction of a 

10 horizontal unit vector U145236 perpendicular to V145236. 

Subsequently, as with the first embodiment, a 
difference M14 52 3 6errv (=M14 52 3 6actvf ilt-Ml 4 52 3 6dmdvf ilt) 
between M145236actvf ilt obtained by passing the 
M145236actv through a low-pass filter and M145236dmdvf ilt 

15 obtained by passing a component M145236dmdv of the 

aforesaid 145236th node compensating floor reaction force 
moment M145236dmd in the direction of a vector V through a 
compensation filter is multiplied by a predetermined gain 
K145236 so as to determine the 145236th node compensating 

20 angle 0145236. 

The compensating angle determiner (0145 determiner) 
114c first calculates a moment M145act generated about the 
145th node floor reaction force central point Q145 when 
translational force components Flact, F4act, and F5act of 

25 actual first, fourth, and fifth node floor reaction forces 
act on desired first, fourth, and fifth node floor 
reaction force central points Ql, Q4, and Q5, respectively. 
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In this case, M145act to be calculated is formed of 
components in the directions of vectors V145 and U145, 
respectively, which are horizontal unit vectors that are 
orthogonal to each other. The directions of the vectors 
5 V145 or U145 may be arbitrary. 

Subsequently, a difference M145err (=M145actf ilt- 
M145dmdfilt) between M145actfilt obtained by passing the 
M145act through a low-pass filter and M145dmdfilt obtained 
by passing the aforesaid 145th node compensating floor 

10 reaction force moment M145dmd (a component in the vector V 

direction and a component in the vector U direction) 
through a compensation filter is multiplied by a 
predetermined gain matrix K145 (diagonal matrix) so as to 
determine the 145th node compensating angle 9145. 8145 is 

15 constructed of an angle component about the axis of the 
vector V and an angle component about the axis of the 
vector U. 

The processing for determining the 236th node 
compensating angle 0236 by the compensating angle 

20 determiner (0236 determiner) 114d is carried out in the 
same manner as the processing of the aforesaid 0145 
determiner 114c. 

The processing by the compensating angle determiners 
114b to 114d explained above determines a set of the node 

25 compensating angles 0145236, 0145, and 0236 such that the 
horizontal component of the actual moment Mact acting on 
the desired total floor reaction force central point P 
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approximates the compensating total floor reaction force 
moment Mdmd. 

As supplementally explained in conjunction with the 
first embodiment, the node compensating angles 8145236, 
0145, and 0236 may be determined as follows. For each n- 
th node (n=145, 236, 145236) having child nodes, a floor 
reaction force central point that causes the horizontal 
component of the moment of the actual node floor reaction 
force of the n-th node (the resultant force of the actual 
node floor reaction forces of all child nodes of the n-th 
node) to be zero is determined as an actual n-th node 
floor reaction force central point. Alternatively, a 
floor reaction force central point that causes the 
horizontal component of the moment, which is obtained by 
subtracting the moment acting on a desired node floor 
reaction force central point of each node that is 
generated by the actual node floor reaction force of the 
node from the moment of the actual node floor reaction 
force of an n-th node (n=145, 236, 145236) , to be zero is 
determined as an actual n-th node floor reaction force 
central point. Then, the difference between the desired 
node floor reaction force central point of the n-th node 
(n=145, 236, 145236) and the actual n-th node floor reaction 
force central point determined as described above, or the 
difference between the values obtained by passing each of 
those node floor reaction force central points through a 
filter is defined as a control amount, and the node 
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compensating angles 0145236, 0145, and 0236 are determined 
on the basis of the control amount (e.g., 0145236, 0145, 
and 0236 are determined by multiplying the control amount 
by a certain gain) so that the control amount approximates 
5 zero. 

A corrected desired ground contact portion 
position/posture calculator 114g in the second embodiment 
shown in Fig. 25 corrects the desired ground contact 
portion position/posture (actually the desired ground 

10 contact portion position in the robot shown in Fig. 1) of 

each ground contact portion 10 so as to obtain a corrected 
desired ground contact portion position/posture. More 
specifically, referring to Fig. 30 and Fig. 31, the 
desired floor reaction force central points Ql, Q4, and Q5 

15 of the first, the fourth, and the fifth nodes, 

respectively, which are the child nodes of the 145th node, 
are rotationally moved by the 145th node compensating 
angle 0145 (horizontal vector) , the desired floor reaction 
force central point Q145 of the 145th node being the 

20 center of rotation. The Ql, Q4, and Q5 after the 

rotational movement are denoted by Ql', Q4', and Q5', 
respectively. Thus, the 145th node compensating angle 
0145 is the manipulated variable for moving the relative 
relationship among the positions of the desired floor 

25 reaction force central points Ql, Q4, and Q4 of the first, 
the fourth, and the fifth nodes, which are the child nodes 
of the 145th node, without moving the position of the 
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desired floor reaction force central point Q145 of the 
145th node. 

Similarly, the desired floor reaction force central 
points Q2, Q3, and Q6 of the second, the third, and the 
5 sixth nodes, respectively, which are the child nodes of 

the 236th node, are rotationally moved by the 236th node 
compensating angle 0236 (horizontal vector) , the desired 
floor reaction force central point Q236 of the 236th node 
being the center of rotation. The Q2, Q3, and Q6 after 

10 the rotational movement are denoted by Q2', Q3', and Q6' , 

respectively. Thus, the 236th node compensating angle 
0236 is the manipulated variable for moving the relative 
relationship among the positions of the desired floor 
reaction force central points Q2, Q3, and Q6 of the second, 

15 the third, and the sixth nodes, which are the child nodes 
of the 236th node, without moving the position of the 
desired floor reaction force central point Q236 of the 
236th node. 

These rotational movements are visually shown in Fig. 

20 30 . 

Subsequently, the desired floor reaction force 
central points Q145 and Q236 of the 145th and the 236th 
nodes, which are the child nodes of the 145236th node, are 
rotationally moved by the 145236th node compensating angle 
25 0145236 about the axial center in the same direction 

(horizontal direction orthogonal to a segment Q145Q236) as 
that of the vector (horizontal vector) of the aforesaid 
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error M145236errv, the desired floor reaction force 
central point P (desired total floor reaction force 
central point) of the 145236th node being the center of 
rotation. The Q145 and Q236 after the rotational movement 
5 are denoted by Q145' and Q236', respectively, as shown in 
Fig. 31. Thus, the 145236th node compensating angle 
0145236 is the manipulated variable for moving the 
relative relationship between the positions of the desired 
floor reaction force central points Q145 and Q236 of the 

10 145th and the 236th nodes, which are the child nodes of 

the 145236th node, without moving the position of the 
desired floor reaction force central point P of the 
145236th node (root node) . 

Next, referring to Fig. 31, the desired node floor 

15 reaction force central points Ql', Q4', and Q5' after the 
previous rotational movement are moved in parallel by a 
vector Q145_Q145' . This provides final corrected desired 
node floor reaction force central points Ql", Q4", and Q5" 
of the first, the fourth, and the fifth nodes. Similarly, 

20 the desired node floor reaction force central points Q2', 
Q3' , and Q6' after the previous rotational movement are 
moved in parallel by a vector Q236_Q236' . This provides 
final corrected desired node floor reaction force central 
points Q2", Q3", and Q6" of the second, the third, and the 

25 sixth nodes. 

Lastly, the desired ground contact portion position 
of an n-th ground contact portion (n=l , 2 , 3 , 4 , 5 , 6) is moved 
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in parallel by a vector Qn_Qn". This corrects the desired 
ground contact portion position of each ground contact 
portion 10 (more precisely, the relative relationship 
among the desired ground contact portion positions of the 
ground contact portions 10). More specifically, for each 
node having child nodes, the manipulated variable 

(correction amount) of the relative relationship (relative 
positional relationship) among the desired ground contact 
portion positions of the ground contact portions 10, which 
are the descendant nodes of the node, is determined on the 
basis of the compensating angles 9145, 6236, and 6145236, 
and combining the manipulated variables (correction 
amounts) corrects the mutual relative relationship among 
the desired ground contact portion positions of the ground 
contact portions 10. 

In a robot in which the postures of ground contact 
portions are controllable and floor reaction force moments 
can be generated about the desired floor reaction force 
central points of the ground contact portions, the 
operation of a foot posture rotation about a desired 
ground contact portion floor reaction force central point 

(desired node floor reaction force central point) of each 
ground contact portion may be performed by the technique 
shown in Japanese Unexamined Patent Application 
Publication No. H10-277969 (composite-compliance control). 
More specifically, as supplementally explained in 
conjunction with the first embodiment, the desired posture 
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of the n-th ground contact portion may be corrected about 
Q" after the n-th ground contact portion is moved in 
parallel as described above. 

A deformation compensation amount calculator 114n in 
5 the second embodiment shown in Fig. 25 determines, as with 
that in the aforesaid first embodiment, a deformation 
compensation amount En_cmpn (n=l , 2 , 3 , 4 , 5 , 6 ) for 
compensating for an influence caused by the deformation of 
the compliance mechanism 42 of each of the legs #1 to #6. 

10 More specifically, the deformation compensation amount 
calculator 114n determines a deformation amount 
En_mdfd (n=l, 2, 3, 4, 5, 6) of the compliance mechanism 42 or 
the like of the legs #1 to #6 expected to occur due to a 
corrected desired ground contact portion floor reaction 

15 force Fn_ref mdf d (n=l , 2 , 3 , 4 , 5 , 6) of each ground contact 

portion 10 (the desired ground contact portion floor 
reaction force corrected by adding the node compensating 
floor reaction force moments M145236dmd, M145dmd, and 
M236dmd to a desired ground contact portion floor reaction 

20 force) output from the compensating total floor reaction 
force moment distributor 114a in the second embodiment by 
using a mechanism compliance model. This En_mdfd is 
multiplied by (-1) to determine the deformation 
compensation amount En_cmpn. 

25 The corrected desired ground contact portion 

position/posture with deformation compensation calculator 
114h in the second embodiment shown in Fig. 25 determines, 
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as with that in the first embodiment, the corrected 
desired ground contact portion position/posture with 
deformation compensation by adding a corresponding 
deformation compensation amount En_cmpn to the corrected 
5 desired ground contact portion position/posture (the 

position/posture determined by the aforesaid corrected 
desired ground contact portion position/posture calculator 
114g) of each ground contact portion 10. 

The above is the detailed explanation of the 
10 processing of the hierarchical compliance operation 
determiner 114 in the present embodiment (the second 
embodiment) . 

The arithmetic processing of the control device 50 
other than that explained above is the same as that of the 

15 first embodiment. 

Incidentally, the hierarchical structure in the 
second embodiment may be altered according to an operation 
mode (traveling mode) or the like of the robot 1, as in 
the case of the first embodiment. For example, the 

20 hierarchical structure may be set as shown in Fig. 34. 
The example in the figure is equipped with, as 
intermediate nodes, a 12th node having a first ground 
contact portion and a second ground contact portion as 
child nodes (leaf nodes) , a 34th node having a third 

25 ground contact portion and a fourth ground contact portion 
as child nodes (leaf nodes), a 56th node having a fifth 
ground contact portion and a sixth ground contact portion 
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as child nodes (leaf nodes) , and a 3456th node having a 
56th node and a 34th node as child nodes, the root node 
having the 3456th node and the 12th node as child nodes. 
This arrangement makes it possible to perform compliance 
5 operations and floor configuration estimations, which will 
be discussed hereinafter, more accurately in some cases. 
Incidentally, the meanings of the reference characters in 
the figure are the same as those shown in, for example, 
the aforesaid Fig. 3(b) or Fig. 24. 

10 

[ Third Embodiment ] 

An explanation will now be given of a third 
embodiment in which a floor configuration estimating 
function and a function for correcting the operation of 

15 the robot 1 on the basis of the result of the estimation 
have been added to the robot 1 (six-legged robot) of the 
second embodiment. In the present embodiment, the 
explanation will be focused mainly on the six-legged robot 
shown in the second embodiment; however, supplemental 

20 explanation will be added also to a four-legged robot in 
some cases. In addition, for the convenience of the 
understanding of the present embodiment, a two-legged 
robot will be referred to in some cases. 

The mechanical construction of the robot 1 in the 

25 present embodiment is the same as that shown in Fig. 1 

explained in the first or the second embodiment (it should 
be noted that the robot 1 has six legs #1 to #6) . Hence, 
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the explanation of the mechanical construction of the 
robot 1 will be omitted. The functional construction of a 
control device 50 provided on the robot 1 in the present 
embodiment is also the same as that shown in the aforesaid 
5 Fig. 2. In the present embodiment, however, the 

hierarchical compliance operation determiner 114 in Fig. 2 
has newly added functions, making it different from that 
in the second embodiment. Further, the processing of the 
components of the control device 50 except for the 

10 hierarchical compliance operation determiner 114 is the 
same as that of the second embodiment. Thus, the 
explanation of the present embodiment will be focused 
mainly on the processing of the hierarchical compliance 
operation determiner 114, and a detailed explanation of 

15 the processing of the control device 50 other than that 
will be omitted. 

Fig. 35 is a block diagram showing the processing 
functions of the hierarchical compliance operation 
determiner 114 in the present embodiment. Of the 

20 functions, those functions that are different from those 
in the second embodiment will be explained. A floor 
configuration estimator 130 serving as a floor 
configuration estimating means and an adder 132 that adds 
an estimated floor configuration error (more specifically, 

25 the estimated value of floor height error, which will be 
discussed later, related to each ground contact portion 
10) output (estimated) by the floor configuration 
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estimator 130 to corrected desired ground contact portion 
position/posture have been newly added to the hierarchical 
compliance operation determiner 114 in the present 
embodiment, and outputs of the adder 132 in place of 
5 corrected desired ground contact portion position/posture 
are supplied to the corrected desired ground contact 
portion position/posture with deformation compensation 
calculator 114h. The rest of the processing of the 
components of the hierarchical compliance operation 

10 determiner 114 is the same as the processing thereof in 
the second embodiment. 

Accordingly, the control processing of the main 
routine of the control device 50 in the present embodiment 
is partly different from the control processing shown in 

15 the flowchart of the aforesaid Fig. 9. Fig. 36 is a 
flowchart showing the control processing of the main 
routine of the control device 50 in the present embodiment. 
As illustrated, in the present embodiment, the processing 
for estimating a floor configuration error (the processing 

20 of the floor configuration estimator 130) in S37 is newly 

added after S36. Furthermore, in S38', desired ground 
contact portion position/posture are corrected on the 
basis of the compensating angles 0145236, 6145, and 0236 
explained in the aforesaid second embodiment and the floor 

25 configuration error estimated in S37, and the desired 
ground contact portion position/posture after the 
correction is further corrected on the basis of a 
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deformation compensation amount so as to obtain corrected 
desired ground contact portion position/posture with 
deformation compensation , which are final desired ground 
contact portion position/posture. In this case, more 
5 specifically, corrected desired ground contact portion 

position/posture are determined on the basis of the 
compensating angles 0145236, 0145, and 0236, as in the 
second embodiment, then the corrected desired ground 
contact portion position/posture are corrected on the 

10 basis of a floor configuration error, and they are further 
corrected on the basis of a deformation compensation 
amount, thereby obtaining corrected desired ground contact 
portion position/posture with deformation compensation. 
The items other than the above are the same as those in 

15 the processing of Fig. 9. 

Hereinafter, the aspects of the present embodiment 
that are different from the second embodiment will be 
specifically explained . 

Before starting the detailed explanation of the 

20 present embodiment, the concepts and terms to be used when 
the floor configuration estimator 130 performs estimation 
will be defined as follows. In the explanation here, for 
the sake of convenience, schematic diagrams of an average 
robot, rather than limiting to the six-legged robot 1 in 

25 the present embodiment, will be used. 

As shown in Fig. 37, Fig. 38, and Fig. 39, a floor 
(or a floor surface) supposed in a desired gait is 
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referred to as "supposed floor." An actual floor on which 
a robot travels is referred to as "actual floor." For the 
convenience of explanation, Fig. 37 shows the four-legged 
robot explained in the first embodiment, and Fig. 38 and 
5 Fig. 39 show a two-legged robot. The meanings of the 

terms explained below remain the same in any multi-legged 
robots, including the six-legged robot 1 in the present 
embodiment . 

The desired n-th ground contact portion floor 
10 reaction force central point Qn defined in the 

hierarchical compliance control explained in the aforesaid 
first and the second embodiments has been the point set at 
the central point of an n-th ground contact portion; 
however, the floor reaction force central point Qn may 
15 alternatively be set on the ground contact surface (bottom 
surface) of the na-th ground contact portion. In this 
case, in the desired gait, the point on the supposed floor 
surface that is supposed to be in contact with the desired 
n-th ground contact portion floor reaction force central 
20 point Qn is referred to as "supposed n-th floor contact 
point Dn . " 

As is obvious from the definition, during the period 
in which the n-th ground contact portion is in contact 
with the ground in the desired gait of a robot, the 
25 desired n-th ground contact portion floor reaction force 

central point Qn and the supposed n-th floor contact point 
Dn share the same coordinates as observed from a 
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supporting leg coordinate system (global coordinate 
system) . In comparison to this, the point at which the 
point that corresponds to the desired n-th ground contact 
portion floor reaction force central point Qn on the 
bottom surface of an actual n-th ground contact portion 
when the robot 1 is actually traveling comes in contact 
with an actual floor is referred to as "actual n-th floor 
contact point Dnact . " 

Examples showing the relationships among these 
points are shown in Fig. 37, Fig. 38, and Fig. 39. 
Incidentally, Fig. 37 shows a four-legged robot viewed 
from the direction of the normal line of a vertical plane 
that passes a desired first ground contact portion floor 
reaction force central point Ql and a desired second 
ground contact portion floor reaction force central point 
Q2 (that is, substantially sideways) , Fig. 38 shows a 
traveling (walking) two-legged robot viewed from the 
direction of the normal line of a vertical plane that 
passes the desired first ground contact portion floor 
reaction force central point Ql and the desired second 
ground contact portion floor reaction force central point 
Q2 (that is, substantially sideways) , and Fig. 39 shows a 
two-legged robot substantially in an upright posture 
viewed from the direction of the normal line of a vertical 
plane that passes the desired first ground contact portion 
floor reaction force central point Ql and the desired 
second ground contact portion floor reaction force central 



point Q2 (that is, substantially from rear) . 

In these Fig. 37 to Fig. 39, the sections of the 
supposed floors on the aforesaid vertical planes are 
indicated by thin lines, while the sections of actual 
floors in the aforesaid vertical planes are indicated by 
thick lines. Incidentally, in Fig 37, the desired posture 
of the robot (the entire posture of the robot at an 
instantaneous value of a desired gait) and the actual 
posture are indicated by dashed lines and solid lines, 
respectively. Further, in Fig. 38 and Fig. 39, the 
desired postures of the robots (the entire postures of the 
robots at instantaneous values of desired gaits) and 
actual ground contact portion position/posture are 
indicated by thin lines and thick lines, respectively. 
Actual n-th floor contact points in these situations are 
the points on actual floor surfaces, and they are at the 
positions shown in Fig. 37, Fig. 38, and Fig. 39. 

The configuration difference of an actual floor 
surface with respect to a supposed floor surface is 
referred to as a floor configuration error. As the 
indexes for quantitatively representing floor 
configuration errors, an n-th node floor height error and 
an n-th node floor inclination error are defined as 
follows . 

The height of a floor surface at an n-th floor 
contact point is referred to as "n-th ground contact 
portion floor height. " In relation to an n-th node that 
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is a leaf, the difference between an actual n-th ground 
contact portion floor height and a supposed n-th ground 
contact portion floor height is referred to as "n-th 
ground contact portion floor height error 7 ' or "n-th node 
5 floor height error." The inclination of the floor surface 

at an n-th floor contact point is referred to as "n-th 
ground contact portion floor inclination." In relation to 
an n-th node that is a leaf, the difference between an 
actual n-th ground contact portion floor inclination and a 

10 supposed n-th ground contact portion floor inclination is 

referred to as "n-th ground contact portion floor 
inclination error" or "n-th node floor inclination error." 
An example of the ground contact portion floor inclination 
error is shown in Fig. 39. 

15 With respect to all j-th nodes, which are leaf nodes, 

the set of node compensating angles for the relationship 
between desired j-th ground contact portion 
position/posture and the height and inclination of a 
supposed j-th floor surface (specifically, the height and 

20 inclination of a supposed floor surface at a supposed j-th 
floor contact point) and the relationship between 
corrected desired j-th ground contact portion 
position/posture that has been corrected by a compliance 
operation using a set of node compensating angles and the 

25 height and inclination of an actual j-th floor surface 
(specifically, the height and inclination of an actual 
floor surface at an actual j-th floor contact point) to 



agree with each other is referred to as " (set of) node 
floor inclination errors), " and among these, the component 
of the node floor inclination error corresponding to an n- 
th node compensating angle is referred to as "n-th node 
floor inclination error." If an n-th node is a leaf node, 
then the "n-th node floor inclination error" thus defined 
agrees with "the n-th node floor inclination error" (= the 
difference between an actual n-th ground contact portion 
floor inclination and a supposed n-th ground contact 
portion floor inclination) defined in relation to leaf 
nodes previously described. 

After all, the set of node floor inclination errors 
corresponds to a compensation amount necessary to shift 
all ground contact portions of a robot that is traveling 
according to a desired gait from a state in which they are 
parallel to a desired floor surface to a state in which 
they are parallel to an actual floor surface. 

Therefore, by estimating a floor configuration error 
while walking and by adding the estimated floor 
configuration error to desired ground contact portion 
position/posture, the actual floor reaction force moment 
of each node will be the same as that when the robot is 
walking on a supposed floor even if there is a floor 
configuration error. Naturally, the actual floor reaction 
force moment of the ground contact portion, which is the 
actual floor reaction force moment of a leaf node, agrees 
with a desired ground contact portion floor reaction force 
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moment . 

Normally, a floor configuration may be represented 
using the A> n-th node floor inclination error 7 ' defined as 
above. If, however, a certain node has three child nodes, 
5 and the desired floor reaction force central points of the 
three child nodes are aligned on the same straight line or 
if a certain node has four or more child nodes, then it 
would be difficult to represent a floor configuration. 

Hence, in the explanation given below, the following 
10 expressions that can be generally applied will be used for 
n-th nodes that are not leaves. The weights used to 
determine a predetermined weighted average in the 
following definition are to be the same as the aforesaid 
weights determined as described above by the desired floor 
15 reaction force distributor 102. 

Definition : 

When all the heights and inclinations of a desired ground 
contact portion are set to agree with the corresponding 

20 heights and inclinations of an actual floor surface, and 
when the desired floor reaction force central point of an 
arbitrary node is expressed by a predetermined weighted 
average of the desired floor reaction force central points 
of all child nodes thereof (i.e., an internally dividing 

25 point based on a predetermined internal division ratio) , 
regarding an arbitrary n-th node, the height obtained by 
subtracting the height (the position in the vertical 
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direction) of the desired floor reaction force central 
point of a parent node of the n-th node from the height 
(the position in the vertical direction) of the desired 
floor reaction force central point of the n-th node is 
5 referred to as "actual n-th node relative floor height. " 

Definition : 

When all the heights and inclinations of a desired ground 
contact portion are set to agree with the corresponding 

10 heights and inclinations of a supposed floor surface, and 
when the desired floor reaction force central point of an 
arbitrary node is expressed by a predetermined weighted 
average of the desired floor reaction force central points 
of all child nodes thereof (i.e., an internally dividing 

15 point based on a predetermined internal division ratio) , 
regarding an arbitrary n-th node, the height obtained by 
subtracting the height (the position in the vertical 
direction) of the desired floor reaction force central 
point of a parent node of the n-th node from the height 

20 (the position in the vertical direction) of the desired 

floor reaction force central point of the n-th node is 
referred to as "supposed n-th node relative floor height." 

The height obtained by subtracting a supposed n-th 
node relative floor height from an actual n-th node 

25 relative floor height is referred to as an "n-th node 
relative floor height error." The n-th node relative 
floor height error will take the same value when defined 
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as follows. 
Definition : 

When all the heights and postures of desired ground 
5 contact portions are made to agree with corresponding 
ground contact portion floor height errors and ground 
contact portion floor inclination errors, and the desired 
floor reaction force central point of an arbitrary node is 
expressed by a predetermined weighted average of the 

10 desired floor reaction force central points of all child 

nodes thereof (i.e., an internally dividing point based on 
a predetermined internal division ratio) , regarding an 
arbitrary n-th node, the height obtained by subtracting 
the desired floor reaction force central point of a parent 

15 node of the n-th node from the desired floor reaction 

force central point height of the n-th node is referred to 
as "n-th node relative floor height error." 

As is obvious from the definition of the n-th node 
relative floor height error described above, regarding 

20 each node having child nodes, an n-th node relative floor 
height error of all child nodes thereof represents the 
relative relationship of floor height errors. Further, 
regarding each node having child nodes, the weighted 
average value of all child nodes thereof is zero. 

25 In the present embodiment (the third embodiment) , 

the difference between an actual floor surface and a 
supposed floor surface on a desired gait (i.e., a floor 
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configuration error) is compensated for so as to correct 
the desired positions/postures of ground contact portions 
10 to make the ground contact portions 10 that are to be 
in contact with the ground properly come in contact with 
the actual floor surface. Further, in the present 
embodiment, the n-th node relative floor height error 
defined as described above is used as a floor 
configuration parameter representing a floor configuration 
error, and based on this, each n-th ground contact portion 
floor height error (floor configuration error) is 
estimated. Then, based on each estimated n-th ground 
contact portion floor height error (hereinafter referred 
to simply as the n-th floor height error in some cases) , 
the desired position of the n-th ground contact portion 10 
is corrected. 

Based on the above premises, essential sections of 
the present embodiment will be explained in detail. 

The inputs into the floor configuration estimator 
130 of the hierarchical compliance operation determiner 
114 shown in Fig. 35 are, in general, roughly divided as 
follows . 

1) Desired floor reaction force central points (desired 
total floor reaction force central points P or desired n- 
th ground contact portion floor reaction force central 
points Qn (n=l, 2, 3, 4, 5, 6) ) . 

2) Supposed floor surface configuration (coordinates of 
supposed n-th floor contact points and supposed n-th 
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ground contact portion floor inclinations) . 

3) Final desired postures to be followed by an actual 
robot (corrected desired ground contact portion 
positions/postures with deformations) or actual joint 
displacements or frequency weighted average thereof 
(weighted average based on a weight having a frequency 
characteristic) . 

4) Body posture inclination errors. 

5) Actual floor reaction forces (the translational force 
component and the moment component of an actual n-th 
ground contact portion floor reaction force) . 

Incidentally, in the robot 1 in the present 
embodiment, the postures of the ground contact portions 10 
cannot be controlled, so that the supposed n-th ground 
contact portion inclination of a supposed floor surface 
configuration is unnecessary. 

Further, in the robot 1 in the present embodiment, 
the moment component of an actual n-th ground contact 
portion floor reaction force of an actual floor reaction 
force is zero. This, therefore, is not required to be 
supplied to the floor configuration estimator 130. 
However, in the explanation of the present embodiment 
hereinafter, the n-th ground contact portion floor 
reaction force generally includes the moment component of 
an actual n-th ground contact portion floor reaction force 
also, considering a case where the postures of the ground 
contact portions 10 are controllable. Further, in the 
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following explanation, the total number of ground contact 
portions will be frequently referred to as "last leaf node 
number" so as to make it possible to expandably apply the 
present embodiment easily also to a case where the number 
5 of ground contact portions is other than four or six. For 
example, in the six-legged robot 1 shown in Fig. 1, the 
last leaf node number is "6". 

Fig. 40 is a block diagram showing the processing 
functions of the floor configuration estimator 130. The 

10 functional elements constituting the floor configuration 

estimator 130 shown in Fig. 40 will be explained. The 
floor configuration estimator 130 is equipped with a 
mechanism compliance model 134. 

The mechanism compliance model 134 determines the 

15 deformation amount of a compliance mechanism 42 or the 
like of each of the legs #1 to #6 (the compliance 
mechanism 42 and a link mechanism of each leg) when each 
of the ground contact portions 10 is subjected to an 
actual floor reaction force Fn_act (n=l, 2, last leaf node 

2 0 number) , and adds the determined deformation amount to the 
corrected desired ground contact portion position/posture 
with deformation compensation, which are supplied to the 
aforesaid robot geometric model 110 (refer to Fig. 2), so 
as to determine estimated n-th ground contact portion 

25 position/posture (n=l,2, last leaf node number), which 
are the estimated values of the position/posture of an n- 
th ground contact portion (each ground contact portion) 
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after mechanism deformation (more specifically, the 
estimated values of the n-th ground contact portion 
position/posture when it is assumed that an actual body 
posture agrees with a desired body posture) . Incidentally 
the corrected desired ground contact portion 
position/posture with deformation compensation used in 
this case are the past values of the values or the like 
determined in the last control cycle. 

When determining the estimated ground contact 
portion position/posture after mechanism deformation, if a 
follow-up delay of control of a joint displacement of the 
robot 1 cannot be ignored, then the position/posture 
obtained by passing corrected desired ground contact 
portion position/posture with deformation compensation 
through a low-pass filter corresponding to the follow-up 
delay may be used instead of using the corrected desired 
ground contact portion position/posture with deformation 
compensation as it is. 

Alternatively, from a detected value of an actual 
joint displacement of the robot 1, the actual ground 
contact portion position/posture without mechanism 
deformation, which are the actual ground contact portion 
position/posture in a case where there is no mechanism 
deformation, are determined through a robot geometric 
model (the same model as the robot geometric model 110 in 
Fig. 2), and the determined values may be used in place of 
the corrected desired ground contact portion 
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position/posture with deformation compensation. 

Alternatively, a weighted average of the aforesaid 
actual ground contact portion position/posture without 
mechanism deformation and the corrected desired ground 
5 contact portion position/posture with deformation 

compensation may be determined by using a frequency weight 
(weight having a frequency characteristic) , and this may 
be used in place of the corrected desired ground contact 
portion position/posture with deformation compensation. 

10 Strictly speaking, the actual ground contact portion 

position/posture without mechanism deformation mentioned 
above should be used; however, any one of the above may be 
used without much difference as long as the capability of 
joint displacement control is high. 

15 Incidentally, the mechanism compliance model 134 is 

explained in detail in Japanese Unexamined Patent 
Application Publication No. H10-277969 previously proposed 
by the present applicant; therefore, no more explanation 
will be given herein. 

20 Supplementally, in a case where an input to the 

robot geometric model 110 in Fig. 2 does not include 
deformation compensation, that is, if corrected desired 
ground contact portion position/posture without 
deformation compensation (the position/posture determined 

25 by the aforesaid corrected desired ground contact portion 
position/posture calculator 114g) are supplied to the 
robot geometric model 110, then the corrected desired 
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ground contact portion position/posture without 
deformation compensation may be supplied to the mechanism 
compliance model 134 of the floor configuration estimator 
130 . 

5 Returning to the explanation of Fig. 40, the 

estimated ground contact portion position/posture after 
mechanism deformation (n=l, 2, 6) are then rotationally 
moved by the aforesaid body posture inclination error 
Gberr, the desired total floor reaction force central 

10 point P being the center of the rotation, thereby to 
determine n-th estimated ground contact portion 
position/posture after mechanism deformation (n=l, 
2,..., last leaf node number) observed from a global 
coordinate system (supporting leg coordinate system) . 

15 Subsequently, the position of the point corresponding to 

the desired n-th ground contact portion floor reaction 
force central point after the mechanism deformation 
observed from the global coordinate system is determined 
on the basis of the n-th estimated ground contact portion 

20 position/posture after the mechanism deformation 

(n=l, 2, last leaf node number) observed from the global 
coordinate system and the position of the desired n-th 
ground contact portion floor reaction force central point 
observed from the desired ground contact portion position 

25 of an n-th ground contact portion (the desired position of 
the representative point of the n-th ground contact 
portion) . Then, the determined position of the point is 
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defined as an instantaneous estimated floor contact point 
position (instantaneous estimated n-th floor contact point 
position) Qn_estm' . This Qn_estm' corresponds to the 
estimated value of the instantaneous position of an actual 
5 n-th floor contact point. The method for determining the 
instantaneous estimated floor contact point position 
Qn_estm' is equivalent to the method for determining Q" of 
expression 21 in Japanese Unexamined Patent Application 
Publication No. H10-277969, so that no further detailed 

10 explanation thereof will be given herein. 

Subsequently, the result obtained by subtracting the 
supposed n-th floor contact point position Dn from the 
instantaneous estimated n-th floor contact point position 
Qn_estm' provides a bias-included instantaneous n-th 

15 ground contact portion floor height error. This 

Zf n_with_bias ' corresponds to the instantaneous estimated 
value of an n-th ground contact portion floor height error. 
In a case where no actual height of a body is detected, as 
with the present embodiment, a bias error is usually 

20 included. Hence, Zf n_with_bias ' is referred to as the 
bias-included instantaneous n-th ground contact portion 
floor height error. 

Here, as previously defined, the supposed n-th floor 
contact point Dn lies at the same position as a desired n- 

25 th ground contact portion floor reaction force central 

point Qn in a period during which an n-th ground contact 
portion is in contact with the ground. In a desired gait, 
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immediately before an n-th ground contact portion comes in 
contact with the ground, the position of the desired n-th 
ground contact portion floor reaction force central point 
Qn that is expected at the next ground contact is defined 
5 as the supposed n-th floor contact point Dn . In the 

desired gait, immediately after the n-th ground contact 
portion leaves a floor, the position of the desired n-th 
ground contact portion floor reaction force central point 
Qn that was expected at the time of leaving the floor is 

10 defined as the supposed n-th floor contact point Dn . 

Subsequently, an estimated n-th node floor height 
error Zfn_estm (n=l, 2, last leaf node number) is 
determined by the floor height error estimation processing 
subroutine of the flowchart of Fig. 41 on the basis of the 

15 bias-included instantaneous n-th ground contact portion 

floor height error Zf n_with_bias ' (n=l, 2,..., last leaf node 
number) and the n-th ground contact portion floor reaction 
force Fn_act (n=l, 2,..., last leaf node number). 

Here, "hierarchical relat ivi zat ion processing" (or 

20 "hierarchical relativization") used in the floor height 

error estimation processing subroutine or the like will be 
explained . 

The hierarchical relativi zat ion processing is 
generally defined as the processing for determining the 
25 output values of all nodes relative to the sets of values 
(the values of predetermined types of state amounts) input 
to all leaf nodes. More specifically, the hierarchi zat ion 
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relativity processing is the processing for determining 
node output values such that the weighted average of 
output values corresponding to all childe nodes of an 
arbitrary node that is not a leaf node is zero and the 
5 input value (state amount) of an arbitrary leaf node 

agrees with the sum of the output value of the node and 
the output values of all ancestor nodes of the node. 

Hereinafter, determining the value of a certain type 
of output BB by the hierarchical relativization processing 

10 from a certain type of input (state amount) AA to a leaf 

node will be referred to as "determining BB by 
hierarchically relativizing AA." 

The following will explain the algorithm of the 
hierarchical relativization processing. In general, an 

15 input of the hierarchical relativization processing is an 
n-th ground contact portion height Zfn (n denoting a leaf 
node number) and an output thereof is an n-th node 
relative height Zn_rel (n=l, 2, last node number). 
Incidentally, the "last node number" means the largest 

2 0 number among all node numbers, and the last node number is, 
for example, 145236 in the hierarchical structure 
explained in the second embodiment. Further, in the 
explanation of the algorithm, the "n-th ground contact 
portion height" is a designation that generically 

25 represents an input of the hierarchical relativization 
processing, such as the aforesaid n-th ground contact 
portion floor height or an n-th ground contact portion 
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floor height error, and the >x n-th node relative height'' is 
a designation that generically represents an output of the 
hierarchical relativization processing, such as an n-th 
ground contact portion relative floor height error, which 
5 will be discussed later. 

First, a bias-included n-th node height Zn_with_bias 
is determined as follows. If an n-th node is a leaf node 
(i.e., the ground contact portion), then the value of an 
n-th ground contact portion height Zfn is substituted into 

10 the bias-included n-th node height Zn_with_bias . If the 

n-th node is not a leaf node (i.e., the ground contact 
portion) , then the weighted average of the bias-included 
n-th node heights Zn_with_bias of all child nodes of the 
n-th node is determined. The determined weighted average 

15 is defined as the bias-included n-th node height 
Zn_with_bias . It should be noted that a weight 
Wj ( j =1 , 2 , . . . ) determined by the aforesaid desired floor 
reaction force distributor 102 is used as the weight for 
each child node. 

20 More specifically, the bias-included n-th node 

height Zn_with_bias is obtained by expression 32 given 
below . 



If the n-th node is a leaf node; 
2 5 Zn_with_bias=Zf n 

If the n-th node is not a leaf node; 

Zn_with_bias=Z ( Z j_wi th_bias*Wj ) 
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where S denotes the total sum on j , which is j<={set 
of child node numbers of the n-th node} 

. . . Expression 32 

5 According to the above rules, the bias-included node 

height Zn_with_bias (n=l , 2 , . . . , last node number) is 
determined on every node. 

Lastly, an n-th node relative height Zn_rel is 
determined by subtracting the bias-included height 
10 Zh_with_bias of a parent node of the n-th node (this is 

supposed to be an h-th node) from the bias-included n-th 
node height Zn_wi th_bias . 

More specifically, the n-th node relative height 
Zn_rel is determined according to the following expression 
15 33. It should be noted that the h-th node is the parent 
node of the n-th node. 

Zn_rel=Zn_with_bias-Zh_with_bias . . . Expression 33 

20 According to the above rule, the node relative floor 

height Zn_rel (n denoting the number of each node) is 
determined on every node. It should be noted that a node 
relative height Zk_rel(k denoting the number of a root 
node) with respect to a root node is zero. Fig. 42 shows 

25 an example of calculation of a node relative height of a 

four-legged robot shown in the first embodiment, while Fig, 
43 shows an example of calculation of a node relative 
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height of the six-legged robot in the present embodiment. 

The bias-included n-th node height Zn_rel_with_bias 
may alternatively be determined by the following method, 
which provides the same results. 
5 If an n-th node is a leaf node (i.e., the ground 

contact portion) , then the value of an n-th ground contact 
portion height Zfn is substituted into the bias-included 
n-th node height Zn_with_bias . If the n-th node is not a 
leaf node (i.e., the ground contact portion), then the 

10 weighted average of the bias-included heights of the leaf 
nodes of all descendants of the n-th node is determined. 
The determined weighted average is defined as the bias- 
included n-th node height Zn_wi th_bias . It should be 
noted that a weight W j ' is the product of the weight Wj 

15 determined for the node j by the aforesaid desired floor 
reaction force distributor 102 and the weight determined 
by the aforesaid desired floor reaction force distributor 
102 for an ancestor node of the node j and all nodes, 
which are the descendant nodes of the n-th node. 

20 More specifically, the bias-included n-th node 

height Zn_with_bias is obtained by expression 34 given 
below . 



If the n-th node is a leaf node; 
2 5 Zn_with_bias=Zf n 

If the n-th node is not a leaf node; 

Zn_with_bias=Z ( Z j_wi th_bias*Wj 9 ) 
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where S denotes the total sum on j , which is j<={set 
of leaf node numbers of the descendants of a node n} 

. . . Expression 34 



5 Supplementally, the weight W j ' in this case agrees 

with the value obtained by dividing the desired floor 
reaction force of each leaf node by a desired j-th node 
floor reaction force if the desired j-th node floor 
reaction force is not zero. 
10 The above is the hierarchical relativization 

processing . 

The subroutine processing of the estimation 
processing of a floor height error will now be explained 
below by mainly using the flowchart of Fig. 41 showing it. 

15 Incidentally, this processing uses an n-th ground contact 
portion floor height error as an input of the hierarchical 
relativization processing, and an n-th node relative floor 
height error as an output. The like symbols as those 
shown in the aforesaid expressions 32 to 34 or the like 

20 will be used as the reference symbols of these input and 
output . 

Referring to Fig. 41, first, in S50, the aforesaid 
bias-included instantaneous n-th ground contact portion 
floor height error Zf n_with_bias ' is hierarchically 
25 relativized to determine an instantaneous n-th node 

relative floor height error Zn_rel' (n=l , 2 , . . . , las t node 
number) . 
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Subsequently, in S52, the output obtained by 
hierarchically relativizing an estimated n-th ground 
contact portion floor height error, which is an estimated 
value of the n-th ground contact portion floor height 
error determined at the last control cycle of the control 
device 50 (hereinafter referred to as the last estimated 
n-th ground contact portion floor height error Zfn_estm_p) 
is determined as the last estimated n-th node relative 
floor height error Zn_rel_es tm_p (n=l , 2 , . . . , las t node 
number) . It should be noted that, as the weight of each 
node used in this hierarchical relativi zat ion processing, 
the weight Wn (n=l , 2 , . . . last node number) determined by the 
aforesaid desired floor reaction force distributor 102 at 
the current (present) control cycle of the control device 
50 is used. 

Supplementally, in general, if the weight determined 
in the current control cycle (hereinafter referred to as 
the current weight) and the weight determined in the last 
control cycle (hereinafter referred to as the last weight) 
are different, then the value of the last estimated 
relative floor height error of each node determined using 
the last weight and the value of the last estimated 
relative floor height error of each node determined using 
the current weight will be inconveniently different values 
even if the configuration of an actual floor does not 
change. Hence, the last estimated node relative floor 
height error of each node is calculated anew by using the 
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current weight as described above instead of directly 
using the estimated relative floor height error of each 
node determined at the last control cycle as the last 
estimated node relative floor height error of each node. 
5 Subsequently, in S54, an n-th node relative floor 

height error correction amount candidate value 
Zn_inc_cand (n=l , 2 , . . . , last node number) is determined 
according to expression 35 given below. The Zn_inc_cand 
means the provisional value of the correction amount of 

10 the error when the n-th node relative floor height error 

is updated at the current control cycle. 

In this case, the n-th node relative floor height 
error correction amount candidate value Zn_inc_cand is set 
to the product of the difference between the instantaneous 

15 n-th node relative floor height error Zn_rel' and the last 
estimated n-th node relative floor height error 
Zn_rel_estm_p and a predetermined coefficient 
(AT/ (Testm+AT) ) , as shown by expression 35 given below. 



2 0 Zn_inc_cand= (Zn_rel' -Zn_rel_es tm_p) 

* AT/ (Testm+AT) 

. . . Expression 35 
where Testm in expression 35 denotes a time constant 
(the time constant of a primary delay) at the estimation 
25 (update) of an n-th node floor height error, and AT 

denotes a control cycle of the control device 50. 

Thus, when Zn inc cand is set, Zn inc cand is added 
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to Zn_rel_estm_p for each control cycle of the control 
device 50, causing the value of the result of the addition 
to change so as to gradually approximate Zn_rel' . 

Subsequently, in S56, a node request mode (an n-th 
5 request mode mdn_dmd) , which is a required value of the 

mode of each node, is determined on the basis of a timing 
of a desired gait. 

Specifically, in the aforesaid six-legged robot 1, 
an n-th node request mode (n=l, 2, 3, 4, 5, 6) , a 145th node 

10 request mode mdl45dmd, a 236th node request mode md236dmd, 

and a 145236th node request mode mdl45236dmd are set as 
shown in the timing chart of Fig. 44 with respect to the 
elapse of time of a desired gait, and a current request 
mode is determined on the basis thereof. However, if the 

15 gait is different, then the pattern of a node request mode 
should be changed accordingly. Incidentally, regarding 
ON/OFF in the timing charts of a first stage (the 
uppermost stage) and a second stage in Fig. 44, the state 
in which the ground contact portion is in contact with the 

20 ground corresponds to ON, while the state in which it is 
not in contact with the ground corresponds to OFF. 

Supplementally, as the present applicant has 
disclosed in Japanese Unexamined Patent Application 
Publication No. H10-277969, in the case of a robot that 

25 has feet as ground contact portions and that is capable of 
estimating floor inclination errors in the ground contact 
portions, the request mode corresponding to the floor 
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inclination error estimation of the ground contact 
portions should be set as explained in the Publication. 

As shown in Fig. 44, the mode of each node 
(hereinafter referred to simply as the node mode) comes in 
5 ready mode, hold mode, and reset mode. 

The ready mode is the mode for estimating a floor 
configuration. The hold mode is the mode for holding the 
estimated value of the floor configuration (an estimated 
n-th ground contact portion floor height error) (for 

10 maintaining an immediately preceding value) . The hold 
mode is made to exist in a period during which the 
estimated value of the floor configuration may diverge and 
a period during which the accuracy of the estimated value 
of the floor configuration may deteriorate. Further, the 

15 reset mode is the mode for shifting the estimated value of 
the floor configuration to a predetermined initial value 
before the next floor configuration estimation is started 
(the next ready mode begins) . 

Regarding an n-th node (n=l, 2, 3, 4, 5, 6) , which is a 

20 leaf node, if an n-th ground contact portion is in contact 
with the ground on a desired gait (that is, if a desired 
n-th ground contact portion floor reaction force is not 
zero) , then the n-th node request mode is set to the ready 
mode. Thereafter, when the n-th ground contact portion 

25 leaves a floor on the desired gait (that is, when the 

desired n-th ground contact portion floor reaction force 
becomes zero) , the n-th node request mode is set to the 
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hold mode immediately thereafter. Then, after a while, 
the n-th node request mode is set to the reset mode. 
Further, immediately before the n-th ground contact 
portion comes in contact with the ground on the desired 
5 gait, the n-th node request mode is set to the ready mode. 

Regarding an n-th node (n=145, 236, 145236) , which is 
not a leaf node, that is, an n-th node having child nodes, 
if at least one ground contact portion belonging to the n- 
th node is in contact with the ground on the desired gait, 

10 then the n-th node request mode is set to the ready mode. 

Thereafter, when all ground contact portions belonging to 
the n-th node leave the floor on the desired gait, then 
the n-th node request mode is set to hold until 
immediately thereafter. Alternatively, the n-th node 

15 request mode may be set to the hold mode from immediately 
before all the ground contact portions belonging to the n- 
th node leave the floor. Then, after a while, the n-th 
node request mode is set to the reset mode. Further, 
immediately before at least one of the ground contact 

20 portions belonging to the n-th node comes in contact with 
the ground on the desired gait, the n-th node request mode 
is set to the ready mode. 

Subsequently, in S58, it is determined whether an 
estimation enable condition is satisfied, and the mode of 

25 each node is finally determined on the basis of the result 
of the determination and the node request mode. The mode 
of each node to be determined is one of the aforesaid 



ready mode, hold mode, and reset node. The aforesaid node 
request mode has been determined on the basis of whether 
the ground contact portions are in contact with the ground 
or not on the desired gait. In S58, the mode of each node 
is determined, considering whether the ground contact 
portions are actually in contact with the ground or not. 

The estimation enable condition means satisfying 
either expression 36 or 37 given below. In this case, if 
neither expression 36 or 37 is satisfied, then the 
estimation enable condition does not hold. 

Fn_act_z > Fn_min . . . Expression 3 6 

Zn_rel' < Zn_rel_estm_p . . . Expression 37 

where Fn_act_z denotes the translational force 
vertical component of an actual n-th ground contact 
portion floor reaction force (n=l , 2 , . . . , last leaf node 
number) . 

The estimation enable condition is a condition that 
when an n-th node relative floor height error is estimated 
(when a floor configuration error is estimated) , the 
estimated value does not diverge. The divergence here 
means a situation in which, when a correcting operation is 
performed to modify corrected desired ground contact 
portion position/posture so as to offset the influence of 
an actual n-th floor height error by using an estimated n- 



th floor height error Zfn_estm (the estimated value of the 
floor configuration error) that has been estimated as it 
will be discussed later, the estimated n-th floor height 
error Zfn_estm continues to increase and an n-th ground 
contact portion moves away from the floor (floats further 
from the floor) . 

If the estimation of Zfn_estm is ideally executed, a 
predetermined permissible value Fn_min may be zero, 
whereas in actuality, a detection error of Fn_act takes 
place, causing an estimated value to diverge in some cases 
To prevent it, Fn_min is set to be a value that is 
sufficiently larger than a detection error of Fn_act. 

In the present embodiment, the estimation enable 
condition is the condition in which divergence described 
above does not occur. However, the estimation enable 
condition may alternatively be a condition in which a 
predetermined accuracy of estimating a floor configuration 
can be secured. Hence, in place of the translational 
force vertical component of the actual n-th ground contact 
portion floor reaction force Fn_act, a component that is 
perpendicular to a supposed floor surface (or an estimated 
floor surface (estimated actual floor surface) ) out of the 
translational force components of the actual n-th ground 
contact portion floor reaction force Fn_act may be used. 

Incidentally, if a floor configuration error (a 
configuration error between an actual floor surface and a 
supposed floor surface) is simply estimated and not 
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reflected in a walking operation, that is, if the 
correction of the corrected desired ground contact portion 
position/posture to cancel the influence of a floor 
configuration error is not carried out by using an 
5 estimated value of the floor configuration error, then the 
estimated value of the floor configuration error does not 
diverge . 

The mode of each node is determined on the basis of 
the result of the determination on whether the estimation 
10 enable condition is satisfied and on the basis of a node 
request mode. 



If an n-th node request mode is the ready mode and the 
estimation enable condition is satisfied, then the n-th 
15 node mode is set to the ready mode. 

If an n-th node request mode is the ready mode and the 
estimation enable condition is not satisfied, then the n- 
th node mode is set to the hold mode. 

If an n-th node request mode is the hold mode, then the n- 
20 th node mode is set to the hold mode. 

If an n-th node request mode is the reset mode, then the 
n-th node mode is set to the reset mode. 



Thus, an n-th mode is determined to be the ready 
25 mode at the end only if the request mode is the ready mode 
and the estimation enable condition is satisfied. 

Subsequently, in S60 to S70, the n-th node relative 
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floor height error (n=l , 2 , . . . , last node number) associated 
with each of all nodes is estimated. 

Supplementally, as disclosed in Japanese Unexamined 
Patent Application Publication No. H10-277969, in the case 
of a robot that has ground contact portions (feet) whose 
postures can be controlled and that is capable of 
estimating the floor inclination errors in the ground 
contact portions, it is preferred to also estimate the 
floor inclination errors associated with the ground 
contact portions. 

Therefore, the processing of S60 to S70 is 
configured so as to allow floor configuration errors to be 
estimated also when the postures of ground contact 
portions can be controlled. 

The following will specifically explain the 
processing of S60 to S70. In S62, the quantity of child 
nodes of an n-th node is determined. At this time, if the 
number of child nodes (the quantity of child nodes) is two 
then in S64, the floor configuration estimation processing 
for two child nodes, which is the estimation processing of 
the floor configuration error for the quantity, is carried 
out. If the number of child nodes is three, then in S66, 
the floor configuration estimation processing for three 
child nodes, which is the estimation processing of the 
floor configuration error for the quantity, is carried out 
If the number of child nodes is zero, then it is 
determined in S68 whether the n-th node ground contact 
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portion permits control of a floor reaction force moment. 

The processing for the case where the number of 
child nodes is zero will be further explained. If the 
number of child nodes of an n-th node is zero, then it 
5 means that the n-th node is a leaf node, and the n-th node 
corresponds to the ground contact portion. In this case, 
as described above, first, it is determined in S68 whether 
the n-th ground contact portion permits control of a floor 
reaction force moment. Here, for example, in the case of 

10 a robot that has feet whose postures can be controlled as 

ground contact portions and its legs do not include free 
joints, as with a regular bipedal walking robot, floor 
reaction force moments can be generated at the ground 
contact portions. However, in the robot 1 (six-legged 

15 robot) in the present embodiment, the ground contact 

portions 10 engage the spherical joints 12, which are free 
joints; therefore, none of the ground contact portions 10 
can generate floor reaction force moments. In this case, 
no processing is carried out on the n-th node whose number 

20 of child nodes is zero. 

Meanwhile, if it is determined in S68 that floor 
reaction force moments can be controlled, then ground 
contact portion floor inclination error estimation 
processing is carried out in S70. This processing is the 

25 processing for estimating the floor inclination error in 
each ground contact portion. This processing is the 
processing in which the foot floor reaction force central 
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point in the floor inclination estimation processing in 
Japanese Unexamined Patent Application Publication No. 
H10-277969 previously proposed by the present applicant 
has been replaced by the desired floor reaction force 
5 central point of an n-th ground contact portion in the 

present embodiment. Hence, further detailed explanation 
will be omitted in the present description. 

Next, the aforesaid floor configuration estimation 
processing for a two-children node will be explained with 

10 reference to Fig. 45 to Fig. 48. Fig 45 is a flowchart 

showing the subroutine processing of the floor 
configuration estimation processing for a two-children 
node, Fig. 46 and Fig. 47 are flowcharts showing the 
subroutine processing of S6404 and S6408, respectively, of 

15 Fig. 45, and Fig. 48 is a flowchart showing the subroutine 
processing of S6406 and S6410 of Fig. 45. 

In the floor configuration estimation processing for 
two-children nodes, the modes of all child nodes of an n- 
th node having two child nodes (the mode determined in S58 

20 of Fig. 41) are determined in S6400, as shown by the 

flowchart of Fig. 45. The results of the determination 
are divided into three, namely, "all ready," "all reset," 
and "others (else) . " In the following explanation, the 
two child nodes of the n-th node will be denoted as the i- 

25 th node and the j-th node. 

Here, if it is determined that the modes of the 
child nodes are "all ready, " then it is determined in 
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S6402 whether a resultant force Fn_z (=Fi_act_z+Fj_act_z ) 
of the translational force vertical components Fi_act_z, 
Fj_act_z of the actual node floor reaction forces of the 
child nodes of the n-th node is larger than a 
5 predetermined value Fn_min2 . In other words, Fn_z denotes 
the translational force vertical component of the 
resultant force of the actual floor reaction forces of all 
ground contact portions belonging to the n-th node. 

If the determination result of S6402 is YES, then 

10 intra-group complete estimation processing for a node 

having two child nodes (the processing for virtually 
estimating the node relative floor height error of each of 
the two child nodes owned by the n-th node) is carried out 
in S6404. In this processing, estimated node relative 

15 floor height errors Zi_rel_estm and Zj_rel_estm of the i- 
th node and the j-th node, respectively, which are the two 
child nodes of the n-th node, are determined (updated) 
according to the expressions shown in the flowchart of Fig. 
46. More specifically, Zi_rel_estm will be 

20 representatively explained. A j-th node relative floor 

height error correction amount candidate value Zi_inc_cand 
determined in the aforesaid S54 is added to a value 
Zi_rel_es tm_p of Zi_rel_estm in the last control cycle 
thereby to determine a new estimated j-th node relative 

25 floor height error Zi_rel_estm. The same applies to the 
j-th node. 

Further, if the resultant force Fn z of the floor 
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reaction forces of the two child nodes of the n-th node is 
smaller than the predetermined value Fn_min2 (if the 
determination result of S6402 is NO), then it means that 
the accuracy of estimating a floor configuration error 
5 would be excessively deteriorated, so that no substantial 
estimation processing is carried out, and the intra-group 
total hold processing for a node having two child nodes 
(the processing for holding the estimated node relative 
floor height errors of the two child nodes of the n-th 

10 node without updating them) is carried out in S6406. In 

the hold processing, as shown by the expressions in the 
flowchart of Fig. 48, the values of the estimated node 
relative floor height errors Zi_rel_estm and Zi_rel_estm 
of the i-th node and the j-th node, respectively, are 

15 maintained at the values Zi_rel_estm_p and Zi_rel_estm_p 
in the last control cycle. 

Next, if it is determined in S6400 of Fig. 45 that 
the modes of the two child nodes are "all reset," then 
intra-group total reset processing for a node having two 

20 child nodes (the processing for resetting the estimated 

node relative floor height error of each of the two child 
nodes owned by the n-th node) is carried out in S6408. In 
the reset processing, the estimated node relative floor 
height errors Zi_rel_estm and Zi_rel_estm of the i-th node 

25 and the j-th node, respectively, are updated according to 
the expressions in the flowchart of Fig. 47 such that they 
gradually approximate zero. Incidentally, the meanings of 
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AT and Testm in the expressions are the same as those of 
the aforesaid expression 35. 

More generally speaking, the reset processing is the 
processing in which Zi_rel_estm and Zj_rel_estm are 
5 determined to take values that are closer to zero than 
Zi_rel_estm_p and Z j_rel_estm_p are, while satisfying a 
condition in which the weighted average value of 
Zi_rel_estm and Zj_rel_estm is zero, that is, 
Wi*Zi_rel_estm+Wj *Z j_rel_estm=0 . Incidentally, the reset 

10 processing includes a primary delay element, so that 
infinite time is required for the node relative floor 
height errors to completely return to zero. Hence, a 
finite stabilization function generator previously 
proposed by the present applicant (Japanese Unexamined 

15 Patent Application Publication No. H5-324115) may be used 
to gradually reset the node relative floor height errors 
to zero. 

Further, if the modes of the two child nodes are 
"others," that is, if the modes are neither "all ready" 

20 nor "all reset" in S6400 of Fig. 45 (for example, if the 

modes of the two child nodes are all hold modes) , then the 
same processing as that of S6406 (refer to Fig. 48) is 
carried out in S6410. 

As described above, only in a case where the modes 

25 of the two child nodes of the n-th node are all ready, and 
there is no danger in that the divergence takes place in 
the processing of estimating node relative floor height 
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errors, the substantial estimation processing of the node 
relative floor height errors of the two child nodes is 
carried out. And, even if the modes of the child nodes 
are all ready, if there is a danger of the occurrence of 
5 divergence of estimation processing, then the values of 

the estimated node relative floor height errors of the two 
child nodes are hold. Further, in a situation wherein the 
actual node floor reaction forces of the two child nodes 
are both zero, that is, if no actual floor reaction forces 
10 act on any ground contact portions 10 belonging to an n-th 

node, then the node relative floor height errors of the 
two child nodes are reset so that they are gradually reset 
to zero. 

Referring now to Fig. 49 to Fig. 55, the floor 
15 configuration estimation processing for a three-children 
node S66 in Fig. 41 will be explained. Fig. 49 is a 
flowchart showing the subroutine processing of the three- 
children node floor configuration estimation processing, 
Fig. 50 and Fig. 51 are flowcharts showing the subroutine 
20 processing of S6604 and S6608 of Fig. 49, Fig. 52 is a 
flowchart showing the subroutine processing of S6606, 
S6614, and S6618 of Fig. 49, and Fig. 53 and Fig. 54 are 
flowcharts showing the subroutine processing of S6612 and 
S6616, respectively, of Fig. 49. 
25 In the three-children node floor configuration 

estimation processing, as shown in the flowchart of Fig. 
49, the modes of all child nodes of an n-th node having 
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three child nodes (the modes determined in S58 of Fig. 41) 
are determined in S6600. The determination results are 
divided into six, namely, "all ready, " "all reset, ^ "only 
two child nodes are ready, " "only one child node is hold, 
5 and the rest are reset/' "only two child nodes are hold 
and the rest is reset/' and "others (else)." 

Here, in the flowchart of Fig. 49, to explain more 
generally the floor configuration estimation processing 
for three child nodes, considerations are given not only 

10 to a case where all the ground contact portions 10 

belonging to each intermediate node (the 145th node and 
the 236th node) simultaneously come in contact with the 
ground or leave a floor, as explained in the aforesaid 
second embodiment, but also to a case where a desired gait 

15 of a robot is generated such that one of the ground 

contact portions of each intermediate node is in contact 
with the ground, while the remaining ground contact 
portions leave the floor. In this case, unlike the two- 
children node type, it is necessary to also consider a 

20 case where the modes of the three child nodes are "only 

two child nodes are ready, " "only one child node is hold, 
and the remaining ones are reset," or "only two child 
nodes are hold, and the remaining are reset." In the 
following explanation, the three child nodes of an n-th 

25 node will be referred to as an i-th node, a j-th node, and 
a k-th node. 

Here, if it is determined that the modes of child 



- 246 - 



nodes are "all ready, " then it is determined in S6602 
whether a resultant force Fn_z 

(=Fi_act_z+F j_act_z+Fk_act_z ) resultant force of the 
translational force vertical components Fi_act_z, Fj_act_z, 
5 and Fk_act_z of the actual node floor reaction forces of 
the child nodes of the n-th node is larger than a 
predetermined value Fn_min2 . In other words, Fn_z denotes 
the translational force vertical component of the 
resultant force of the actual floor reaction forces of all 

10 ground contact portions belonging to the n-th node. 

If the determination result of S6602 is YES, then 
intra-group complete estimation processing for a node 
having three child nodes (the processing for virtually 
estimating the node relative floor height error of each of 

15 the three child nodes owned by the n-th node) is carried 

out in S6604. In this processing, estimated node relative 
floor height errors Zi_rel_estm, Zj_rel_estm, and 
Zk_rel_estm of the i-th node, j-th node, and the k-th node, 
respectively, which are the three child nodes of the n-th 

20 node, are determined (updated) according to the 

expressions shown in the flowchart of Fig. 50. More 
specifically, Zi_rel_estm will be representatively 
explained. An i-th node relative floor height error 
correction amount candidate value Zi_inc_cand determined 

25 in the aforesaid S54 is added to a value Zi_rel_estm_p of 
Zi_rel_estm in the last control cycle thereby to determine 
a new estimated i-th node relative floor height error 
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Zi_rel_estm. The same applies to the j-th node and the ki- 
th node. 

If the determination result of S6602 is NO, then it 
means that the accuracy of estimating a floor 
5 configuration error would be excessively deteriorated, so 
that no substantial estimation processing is carried out, 
and the intra-group total hold processing for a node 
having three child nodes (the processing for holding the 
estimated node relative floor height errors of the three 

10 child nodes of the n-th node without updating them) is 

carried out in S6606. In the hold processing, as shown by 
the expressions in the flowchart of Fig. 52, the values of 
the estimated node relative floor height errors 
Zi_rel_estm, Zj_rel_estm, and Zk_rel_estm of the i-th node, 

15 the j-th node, and the k-th node, respectively, are 

maintained at the values Zi_rel_estm_p, Z j_rel_estm_p, and 
Zk_rel_estm in the last control cycle. 

Further, if it is determined in S6600 of Fig. 49 
that the modes of the three child nodes are "all reset," 

20 then intra-group total reset processing for a node having 
three child nodes (the processing for resetting the 
estimated node relative floor height error of each of the 
three child nodes owned by the n-th node) is carried out 
in S6608. In the reset processing, the estimated node 

25 relative floor height errors Zi_rel_estm, Zj_rel_estm, and 
Zk_rel_estm of the i-th node, the j-th node, and the k-th 
node, respectively, are updated according to the 
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expressions in the flowchart of Fig. 51 such that they 
gradually approximate zero. Incidentally, the meanings of 
AT and Testm in the expressions are the same as those of 
the aforesaid expression 35. 
5 More generally speaking, the reset processing is the 

processing in which Zi_rel_estm, Zj_rel_estm, and 
Zk_rel_estm are determined to take values that are closer 
to zero than Zi_rel_estm_p, Z j_rel_estm_p, and 
Zk_rel_estm_p are, while satisfying a condition in which 

10 their weighted average value is zero, that is, 

Wi*Zi_rel_estm+Wj *Z j_rel_estm+Wk*Zk_rel_estm =0 . 
Incidentally, the aforesaid finite stabilization function 
generator (Japanese Unexamined Patent Application 
Publication No. H5-324115) may be used to reset 

15 Zi_rel_estm_p, Z j_rel_estm_p, and Zk_rel_estm_p to zero. 

Further, if it is determined in S6600 of Fig. 49 
that the modes of the three child nodes are "only two 
child nodes are ready," then it is determined in S6610 
whether the translat ional force vertical component Fn_z of 

20 the resultant force of the actual node floor reaction 

forces of the child nodes of an n-th node (the resultant 
force of the actual floor reaction forces of all ground 
contact portions 10 belonging to the n-th node) is larger 
than the predetermined value Fn_min2 . 

25 If the result of the determination is YES, then the 

intra-group partial estimation processing for a node 
having three child nodes (the processing for substantially 



estimating the node relative floor height error of each of 
the three child nodes owned by the n-th node) is carried 
out in S6612. This processing is carried out as shown by 
the flowchart of Fig. 53. In this case, it is assumed 
that the i-th node is not in the ready mode, while the j- 
th node and the k-th node are in the ready mode. 

First, in S66120, the mode of the i-th node is 
determined. If the result of the determination is the 
hold mode, then a new i-th node relative floor height 
error correction amount candidate value Zi_inc_cand' is 
determined to be zero in S66122, or if it is the reset 
mode, then the new i-th node relative floor height error 
correction amount candidate value Zi_inc_cand' is 
determined in S66124 according to the expression in the 
figure. Zi_inc_cand / determined in S66124 denotes an i-th 
node relative floor height error correction amount 
candidate value for gradually bringing Zi_rel_estm_p to 
zero. The meanings of AT and Testm in the expressions of 
S66124 are the same as those of the aforesaid expression 
35. Supplementally, the aforesaid finite stabilization 
function generator (Japanese Unexamined Patent Application 
Publication No. H5-324115) may be used to determine 
Zi_inc_cand' in S66124. 

Subsequently, in S66126, a new j-th node relative 
floor height error correction amount candidate value 
Zj_inc_cand' and a new k-th node relative floor height 
error correction amount candidate value Zk inc cand' are 
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determined according to the expressions in the figure. 

More specifically, Zj_inc_cand' and Zk_inc_cand' 
are determined such that they satisfy a condition 
represented by Wi*Zi_inc_cand' + Wj *Z j_inc_cand' + 
5 Wk*Zk_inc_cand' =0 (a condition in which the weighted 
average value of Zi_inc_cand' , Zj_inc_cand' and 
Zk_inc_cand' is zero) and a condition represented by 
Zj_inc_cand' - Zj_inc_cand = Zk_inc_cand' -Zk_inc_cand. 

Subsequently, in S66128, Zi_inc_cand / , Zj_inc_cand, 

10 and Zk_inc_cand' determined as described above are added 

to the values Zi_rel_estm_p, Z j_rel_estm_p, and 
Zk_rel_estm_p of the relative floor height errors of the 
i-th node, the j-th node, and the k-th node in the last 
control cycle so as to determine new Zi_rel_estm, 

15 Zj_rel_estm, and Zk_rel_estm. 

By determining Zi_rel_estm, Zj_rel_estm, and 
Zk_rel_estm as described above, Zi_rel_estm, Zi_rel_estm, 
and Zk_rel_estm will be determined such that Zj_rel_estm- 
Zk_rel_estm approximates Z j_inc_cand-Zk_inc_cand while 

2 0 satisfying Wi*Zi_rel_estm+Wj *Zi_rel_estm+Wk+Zk_rel_estm=0 

at the same time. 

If the result of the determination of S6610 of Fig. 
49 is NO, then the accuracy of estimating a floor 
configuration error would be excessively deteriorated, so 

25 that no substantial estimation processing is carried out, 
but the same processing as that of the aforesaid S6606 
(refer to Fig. 52) is carried out in S6614. 
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Further, if it is determined in S6600 of Fig. 49 
that the modes of the three child nodes are "only one 
child node is hold and the rest are reset," then the 
processing for a case where only one child mode is hold 
5 and the rest are reset is carried out in S6616. In the 
processing, new node relative floor height errors 
Zi_rel_estm, Zj_rel_estm, and Zk_rel_estm are determined 
according to the expressions shown in the flowchart of Fig. 
54. Incidentally, in this case, it is assumed that the 

10 mode of the i-th node is the hold mode and the modes of 
the j-th node and the k-th node are the reset mode. The 
meanings of AT and Testm in the expressions are the same 
as those in the aforesaid expression 35. 

The processing of Fig. 54 is, more generally, the 

15 processing for determining Zi_rel_estm to be zero, and 
determining Zj_rel_estm and Zk_rel_estm to take values 
that are closer to zero than Z j_rel_estm_p and 
Zk_rel_estm_p are, while satisfying Wi*Zi_rel_estm+ 
Wj *Z j_rel_estm+ Wk*Zk_rel_estm=0 (a condition in which the 

20 weighted average value of Zi_rel_estm, Zj_rel_estm and 

Zk_rel_estm is zero) . Supplementally, by the moment the 
modes of the j-th node and the k-th node both become the 
reset mode, their node weights Wj and Wk should have 
become zero. Hence, based on a condition in that the sum 

25 of the weights Wi, Wj and Wk is 1, Wi will be 1 by that 
moment and Wi*Zi_rel_estm+ Wj *Z j_rel_estm+ 

Wk*Zk_rel_estm=0 , so that Zi_rel_estm will be zero by that 
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moment. Thus, holding the value of the i-th node 
Zi_rel_estm means maintaining the value at zero. 
Therefore, in the processing of Fig. 54, the value of 
Zi_rel_estm is determined to be zero. 
5 Incidentally, the aforesaid finite stabilization 

function generator (Japanese Unexamined Patent Application 
Publication No. H5-324115) may be used in the processing 
for gradually resetting Zj_rel_estm and Zk_rel_estm to 
zero . 

10 Further, if it is determined in S6600 of Fig. 49 

that the modes of the child nodes are "only two child 
nodes are hold and the rest is reset," then the processing 
for a case where only two child modes are hold and the 
rest is reset is carried out in S6618. In the processing, 

15 new node relative floor height errors Zi_rel_estm, 

Zj_rel_estm, and Zk_rel_estm are determined according to 
the expressions shown in the flowchart of Fig. 55. 
Incidentally, in this case, it is assumed that the modes 
of the i-th node and the j-th mode are both the hold mode 

20 and the mode of the k-th node is the reset mode. The 

meanings of AT and Testm in the expressions are the same 
as those in the aforesaid expression 35. 

The processing of Fig. 55 is, more generally, the 
processing for holding Zi_rel_estm and Zj_rel_estm at the 

25 values in the last control cycle, and determining 

Zk_rel_estm to take a value that is closer to zero than 
Zk_rel_estm_p is, while satisfying Wi*Zi_rel_estm+ 
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Wj *Z j_rel_estm+ Wk*Zk_rel_estm=0 (a condition in which the 
weighted average value of Zi_rel_estm, Z j_rel_estm and 
Zk_rel_estm is zero) . Supplementally, by the moment the 
mode of the k-th mode becomes the reset mode, Wk should 
5 have become zero. 

Incidentally, the aforesaid finite stabilization 
function generator (Japanese Unexamined Patent Application 
Publication No. H5-324115) may be used in the processing 
for gradually resetting Zk_rel_estm to zero. 
10 Further, if it is determined to be "Others" in S6620 

of Fig. 49 (e.g., if the modes of the three child nodes 
are all hold mode) , then the same processing as that of 
the aforesaid S6606 (refer to Fig. 52) is carried out in 
S6620 . 

15 As described above, only in a case where the modes 

of two or more child nodes are ready out of the modes of 
the three child nodes of the n-th node, and there is no 
danger in that the divergence takes place in the 
processing of estimating node relative floor height errors, 

20 the substantial estimation processing of the node relative 
floor height errors of the two or more child nodes is 
carried out. And, even if the modes of two or more child 
nodes are all ready, if there is a danger of the 
occurrence of divergence of estimation processing, then 

25 the values of the estimated node relative floor height 
errors of the three child nodes are hold. 

As described above, in S60 to S66 of Fig. 41, 
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estimated n-th relative floor height errors 
Zn_rel_estm (n=l , 2 , . . . , last node number) are determined. 
Incidentally, the relative floor height error of the root 
node is zero. 

5 In the processing of the flowchart of Fig. 41, 

lastly, in S72, the sum of the estimated relative floor 
height errors of all ancestor nodes of an n-th node 
(n=l , 2 , . . . , last leaf node number) and an estimated n-th 
node relative floor height error is determined, and the 

10 determined sum is defined as an estimated n-th ground 

contact portion floor height error (estimated n-th floor 
height error) Zfn_estm. 

The above is the subroutine processing of the 
estimation processing of floor height errors in Fig. 40. 

15 Next, returning to the explanation of Fig. 35, the 

estimated n-th floor height error Zf n_estm (n=l , 2 , . . . , last 
leaf node number) sequentially determined by the floor 
configuration estimator 130 as described above is added to 
the corrected desired ground contact portion 

20 position/posture of each ground contact portion 10 by an 
adder 132 so as to determine corrected desired ground 
contact portion position/posture with floor configuration 
error compensation. Then, the corrected desired ground 
contact portion position/posture with floor configuration 

25 error compensation are input, in place of corrected 

desired ground contact portion position/posture, to the 
corrected desired ground contact portion position/posture 
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with deformation compensation calculator 114h. 

As the processing of the control device 50 including 
the floor configuration estimator 130 and the adder 132 
explained above is repeatedly carried out at each control 
5 cycle of the control device 50, the estimated n-th floor 
height error Zfn_estm converges to an actual n-th floor 
height error. Further, desired ground contact portion 
positions/postures are corrected on the basis of the 
estimated n-th floor height errors Zfn_estm corresponding 

10 to the ground contact portions so as to absorb an 

influence exerted by an actual n-th floor height error on 
an actual floor reaction force. 

If all n-th ground contact portions (n=l , 2 , . . . , last 
leaf node number) are in contact with the ground, then the 

15 point corresponding to a desired n-th ground contact 
portion floor reaction force central point Qn on the 
actual ground contact surface of an n-th ground contact 
portion should agree with an actual n-th floor contact 
point Dn_act . Therefore, the aforesaid instantaneous n-th 

20 node relative floor height error Zn_rel' should not change. 
In actuality, however, the instantaneous n-th node 
relative floor height error Zn_rel' obtained by the 
aforesaid calculation algorithm of the aforesaid floor 
configuration estimator 130 significantly changes due to 

25 the vibrations and electrical noises of a mechanical 

system or control device of the robot 1. Therefore, if 
the instantaneous n-th node relative floor height error is 
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directly used as an estimated n-th node relative floor 
height error, and based on this, the estimated n-th floor 
height error Zfn_estm is determined (that is, the sum of 
the instantaneous relative floor height errors of all 
5 ancestor nodes of an n-th node (n=l , 2 , . . . , last leaf node 
number) and the instantaneous n-th node relative floor 
height error is defined as the estimated n-th floor height 
error Zfn_estm) , and further, the result obtained by 
adding the estimated n-th floor height error Zfn_estm to 

10 the corrected desired ground contact portion 

position/posture is supplied to the corrected desired 
ground contact portion position/posture with deformation 
compensation calculator 114h, as shown in Fig. 35, then 
the ground contact portions 10 of the robot 1 will 

15 oscillate or severely vibrate. 

Meanwhile, in the intra-group complete estimation 
processing for a node having two child nodes, the intra- 
group complete estimation processing for a node having 
three child nodes, and the intra-group partial estimation 

20 processing for a node having three child nodes described 
above, the transfer function from the instantaneous n-th 
node relative floor height error Zn_rel' to the estimated 
n-th node relative floor height error Zn_rel_estm will be 
a primary delay low-pass filter. In other words, the 

25 estimated n-th node relative floor height error 

Zn_rel_estm will be the one obtained by passing the 
instantaneous n-th node relative floor height error 
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Zn_rel' through a low-pass filter. Therefore, even when 
the estimated n-th floor height error Zfn_estm determined 
on the basis of the estimated n-th node relative floor 
height error Zn_rel_estm is added to the corrected desired 
ground contact portion position/posture, as shown in Fig. 
35, the oscillation or vibration of the ground contact 
portions 10 will hardly occur. This makes it possible to 
restrain the ground contact portions 10 from oscillating 
or vibrating. 

Incidentally, in the present embodiment, the time 
constant of the aforesaid low-pass filter is Testm. Other 
than by the processing of the floor configuration 
estimator 130 explained in the present embodiment, it is 
possible to accomplish a construction in which the 
transfer function from the instantaneous n-th node 
relative floor height error Zn_rel' to the estimated n-th 
node relative floor height error Zn_rel_estm will be a 
low-pass filter. 



The characteristics of the floor configuration 
estimator 130 in the present embodiment will now be 
explained . 

Even if each node compensating angle is changed and 
the corrected desired ground contact portion 
position/posture with deformation compensation, which are 
the final desired ground contact portion position/posture, 
are changed to generate node compensating moments required 
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for the stabilization control of the posture of the robot 
1, the point corresponding to the desired n-th ground 
contact portion floor reaction force central point Qn of 
the n-th ground contact portion 10 on an actual ground 
5 contact surface remains in agreement with the actual n-th 
floor contact point Dnact as long as the ground contact 
portions 10 are actually in contact with the ground. 
Instead, the compliance mechanism 42 or the like of each 
leg deforms or the position/posture of the body 24 change. 
10 In other words, the compliance mechanism 42 or the like 

deforms or the position/posture of the body 24 change in 
order to cancel the change of the corrected desired ground 
contact portion position/posture with deformation 
compensation . 

15 The floor configuration estimator 130 in the present 

embodiment cancels the influences exerted on the estimated 
n-th floor height error Zfn_estm by the deformation amount 
of the compliance mechanism 42 or the like, which is 
calculated by the mechanism compliance model 134 on the 

20 basis of an actual floor reaction force, and the body 

posture inclination error Gberr by the time the estimated 
n-th floor height error Zf n_estm (n=l , 2 , . . . , las t leaf node 
number) is calculated from the corrected desired ground 
contact portion position/posture with deformation 

25 compensation. Hence, even if a body posture inclination 
error occurs or corrected desired ground contact portion 
position/posture with deformation compensation change, the 



estimated n-th floor height error Zfn_estm is not 
influenced thereby . 

This means that the processing for estimating a 
floor configuration is not subjected to interference by 
the compliance control or posture control of the robot 1. 
Therefore, even when the estimated n-th floor height error 
Zfn_estm is added to the corrected desired ground contact 
portion position/posture, as shown in Fig. 35, the 
stability allowance (resistance to oscillation) of the 
control device of the robot 1 hardly reduces. In other 
words, control and processing will not interfere with each 
other and cause oscillation even if the compliance control, 
the posture control and the floor configuration estimation 
processing and the operation for correcting a desired gait 
of the robot 1 by using the estimated value of a floor 
configuration error are simultaneously performed. This 
means, in brief, that the leg compensating operation to 
cancel the influence exerted on a floor reaction force by 
a floor configuration error (the operation for correcting 
the position/posture of a ground contact portion) can be 
simultaneously performed while simultaneously estimating a 
plurality of parameters of the floor configuration error. 
Moreover, the leg compensating operation for posture 
control (the operation for correcting the position/posture 
of a ground contact portion) can be simultaneously 
performed . 

Further, if the estimated n-th floor height error 
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Zfn_estm of each ground contact portion 10 is added to the 
corrected desired ground contact portion position/posture, 
as shown in Fig. 35, then even if there is actually an n- 
th floor height error, the influence thereof can be offset, 
so that the actual total floor reaction force will 
steadily be the same as that in a case where the robot 1 
is traveling on a supposed floor. Furthermore, the 
estimation of the estimated n-th floor height error 
Zfn_estm and the correction of corrected desired ground 
contact portion position/posture by using the estimated n- 
th floor height error Zfn_estm are sequentially carried 
out for each control cycle; therefore, even if a floor 
configuration changes in the middle, the n-th floor height 
error after the change can be estimated and the influence 
exerted by the change in the floor configuration can be 
cancelled on the basis of the estimated value. However, 
the floor configuration estimator 130 includes a low-pass 
filter, as mentioned above, so that an actual total floor 
reaction force is transi tionally subject to the influence 
of a floor configuration error immediately after the 
ground contact portions 10 come in contact with the ground 
or if the floor configuration changes in the middle. 
Thereafter, however, the influence is attenuated by the 
time constant Testm. 

Further, there are the following characteristics. 
1) Control is resistant to failure even if a floor 
configuration error is large. This is because the 
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hierarchical compliance control does not carry out 
approximation limited to minute compensating angles. 
2) The accuracy of estimating floor configuration errors 
is high. 

5 3) Resistance to the occurrence of oscillation 

attributable to the interference with the robot posture 
stabilization control, permitting a shorter time constant 
for estimation processing to be achieved. This makes it 
possible to enhance the responsiveness of the leg 

10 compensating operation to offset the influence exerted by 

a floor configuration error on a floor reaction force, so 
that the transitional influence exerted by the floor 
configuration error on the floor reaction force can be 
quickly eliminated . 

15 If there is no correlation in the relationship 

between the estimated n-th floor height error in a landing 
period of one step before (a period in which a certain 
ground contact portion 10 comes in contact with the 
ground) and the estimated n-th floor height error in a 

20 landing period following the above landing period of one 
step before when a robot is traveling, then it is 
preferred to forcibly and gradually converge the estimated 
n-th floor height error to zero, as shown in the present 
embodiment. However, if, for example, it is known that 

25 the undulation of an actual floor surface not considered 
in a supposed floor is gentle, then it is considered that 
there is some correlation in the aforesaid relationship. 
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In this case, the estimated n-th floor height error in the 
current landing period may be forcibly and gradually 
converged to the value obtained by multiplying the 
estimated n-th floor height error in the landing period of 
5 one step before by a positive constant that is smaller 
than 1 . 

Further, the convergence desired value of an 
estimated n-th floor height error in the current landing 
period may be determined by using not only the estimated 

10 n-th floor height error in the landing period of one step 
before but also the estimated n-th floor height error in 
the landing period of a plurality of steps before. 
Further, the convergence desired value may be determined 
by using the estimated n-th node floor height error and 

15 the estimated n-th node floor inclination error of another 
node in the landing period of current step, one step 
before, or a plurality of steps before. 



Since the present embodiment (the third embodiment) 
20 has been constructed as described above, the estimation of 
floor configurations, specifically, the floor height 
errors associated with ground contact portions, can be 
simultaneously, in other words, compositely, estimated 
with high accuracy even in a robot having many ground 
25 contact portions, which has been difficult to accomplish 
by conventional technologies. Moreover, if the ground 
contact portions of a robot are provided such that their 



postures can be controlled, and floor inclination errors 
are estimated in addition to floor height errors in the 
processing for estimating floor configurations, then the 
floor inclination errors can be also simultaneously 
estimated with high accuracy. 

Furthermore, by correcting a desired ground contact 
portion position/posture trajectory on the basis of the 
result of estimating a floor configuration, even if a 
floor configuration is different from a supposed 
configuration, the influence thereof can be absorbed, 
making it possible to generate a floor reaction force as 
desired . 

In particular, the steady error of an actual floor 
reaction force from a control desired value, which has not 
been completely removed by the hierarchical compliance 
control that does not include corrections based on the 
estimated values of floor configuration errors, can be 
brought close to zero as much as possible. In other words, 
the steady errors of floor reaction forces caused by floor 
configuration errors can be eliminated. 

Furthermore, the arrangement has been made such that 
the estimation of a floor configuration is interrupted in 
a situation wherein the accuracy of estimating a floor 
configuration may deteriorate or a situation wherein the 
estimated value thereof may diverge. This adds to the 
aforesaid advantages by preventing estimated values from 
being inappropriate . 
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Incidentally, the floor configuration estimator 130 
of a robot according to the present embodiment is expected 
to estimate floor configurations by the aforesaid 
techniques, but it is not essential for the floor 
5 configuration estimator 130 to correct motions on the 
basis of estimated values. 

[ Fourth Embodiment ] 

A control device (a floor configuration estimator in 

10 particular) of a mobile robot according to a fourth 

embodiment of the present invention will now be explained. 
In the fourth embodiment, to explain it in brief, the 
block diagram of the floor configuration estimator 130 
shown in Fig. 40 of the aforesaid third embodiment has 

15 been equivalently converted. More specifically, the floor 
reaction force of each node is estimated on the basis of 
the estimated value of a floor configuration estimated 
immediately before (the past value of an estimated value, 
such as the estimated value in the last control cycle) , a 

20 desired gait that has been finally corrected and 

determined (detailedly, corrected desired ground contact 
portion position/posture with deformation compensation 
including a compliance operation) (or an actual joint 
displacement) , and an actual body posture inclination 

25 error Gberr. Based on the difference between the 

estimated value and the actual floor reaction force of 
each node, the correction amount candidate value of the 
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estimated value of the floor configuration is determined 
so that the difference approximates zero. If it is 
determined that the estimation of the floor configuration 
will not diverge, then the estimated value of the floor 
configuration that has been estimated immediately before 
is corrected on the basis of the correction amount 
candidate value of the estimated value of the floor 
configuration. This processing corresponds to a 
hierarchical floor configuration estimating means that is 
an advanced version of the means for estimating a floor 
inclination related to each foot such that the difference 
between the supposed moment about the floor reaction force 
central point of the foot of each leg of a biped mobile 
robot and an actual moment approximates zero and the means 
for estimating the interference angle between both legs 
such that the difference between the supposed moment about 
a total floor reaction force central point and an actual 
moment approximates zero in the Japanese Unexamined Patent 
Application Publication No. H10-277969 previously proposed 
by the present applicant. 

Thus, the present embodiment differs from the third 
embodiment only in the processing of a floor configuration 
estimator 130, so that the explanation of the processing 
of those other than the floor configuration estimator 130 
will be omitted. 

Fig. 57 is a block diagram showing the functional 
means of the floor configuration estimator 130 in the 



present embodiment. Referring to this Fig. 57, the floor 
configuration estimator 130 in the present embodiment will 
be explained below. 

First, based on corrected desired n-th ground 
contact portion position/posture with deformation 
compensation (n=l,2,..., last leaf node number) of each 
ground contact portion 10, the desired n-th ground contact 
portion floor reaction force central point of the ground 
contact portion 10 observed from the desired ground 
contact portion position of each ground contact portion 10, 
and the aforesaid posture inclination error Bberr, the 
corrected desired n-th ground contact portion 
position/posture with deformation compensation is 
rotationally moved by Gberr, a desired total floor 
reaction force central point being the center of the 
rotation, so as to determine the corrected desired n-th 
ground contact portion position/posture (n=l , 2 , . . . , last 
leaf node number) with deformation compensation after 
rotation. A supposed n-th floor contact position 
Dn (n=l , 2 , . . . , last leaf node number) on a desired gait is 
subtracted from the determined corrected desired n-th 
ground contact portion position/posture (n=l , 2 , . . . , last 
leaf node number) with deformation compensation after 
rotation so as to determine an n-th ground contact portion 
interference height Zn_int. This is supplied to a 
mechanism compliance model (inverse model) provided in a 
floor configuration estimator 130, thereby determining an 
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estimated n-th ground contact portion floor reaction force, 
which is the estimated value of the floor reaction force 
of each ground contact portion 10. 

Incidentally, the mechanism compliance model here is 
used to determine the mutual relative relationship among 
the estimated ground contact portion floor reaction forces 
on the basis of the mutual relative relationship among 
ground contact portion interference heights, and it finds 
no meaning in absolute values. Further, if the detected 
value of an actual floor reaction force Fn_act of an n-th 
ground contact portion is smaller than a certain threshold 
value Fn_min3, then it is assumed that the n-th ground 
contact portion is not in contact with the ground also in 
the aforesaid mechanism compliance model. 

Further, the aforesaid estimated n-th ground contact 
portion floor reaction force is subtracted from the 
detected value of the actual floor reaction force Fn_act 
of an n-th ground contact portion (n=l , 2 , . . . , last leaf 
node number) to determine the estimated error of the n-th 
ground contact portion floor reaction force Ff n_es tm_err . 
The estimated error of the n-th ground contact portion 
floor reaction force Ffn_estm_err is expressed in terms of 
a force; therefore, it is converted into a height error by 
a conversion value Cn (e.g., the reciprocal of a spring 
constant) and the result is adopted as an n-th ground 
contact portion floor height error correction amount 
candidate value Zfn inc cand. Incidentally, the 
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conversion value Cn is not necessarily a diagonal matrix. 

Subsequently, hierarchical relat ivi zation is 
performed by the hierarchical relat ivi zation processing 
described above on the basis of the determined n-th ground 
contact portion floor height error correction amount 
candidate value Zfn_inc_cand so as to determine an n-th 
node relative floor height error correction amount 
candidate value Zn_inc_cand (n=l , 2 , . . . , last node number). 
Then, based on the n-th node relative floor height error 
correction amount candidate value Zn_inc_cand, an 
estimated floor height error (estimated n-th floor height 
error) Zf n_estm (n=l , 2 , . . . , last leaf node number) is 
determined by the subroutine processing of the estimation 
processing of floor height errors. The subroutine 
processing of the estimation processing of floor height 
errors here is identical to the processing of S56 to S72 
shown in Fig 4 1 . 

It is desirable to carry out the ground contact 
portion floor inclination error estimation processing as 
explained in conjunction with S70 of Fig. 41 in the case 
of a robot that has feet whose postures can be controlled 
as ground contact portions and is capable of estimating 
the floor inclination errors in ground contact portions, 
as disclosed in Japanese Unexamined Patent Application 
Publication No. H10-277969. 

Here, the third embodiment and the fourth embodiment 
(the present embodiment) will be compared. The fourth 



embodiment is, in brief, the converted equivalent of the 
block diagram of the floor configuration estimator 130 of 
the third embodiment. Hence, the advantages of the fourth 
embodiment are the same as the advantages of the third 
embodiment. Further, as with the third embodiment, it is 
not essential to correct motions on the basis of the 
estimated values of floor configurations. 

In the third and the fourth embodiments, distributed 
pressure sensors may be used as floor reaction force 
sensors. Distributed pressure sensors make it possible to 
estimate more finely the deformations of ground contact 
portions due to actual floor reaction forces than force 
sensors, such as the six-axis force sensor 34, so that the 
accuracy in estimating floor configurations can be 
improved . 

Furthermore, as shown in Fig. 1 of Japanese Patent 
No. 3035051 by the present applicant, a plurality of 
contact sensors may be disposed on a ground contact 
portion (e.g., on the four corners of the ground contact 
portion) , and it may be determined in which direction the 
ground contact portion is likely to float on the basis of 
the output signals thereof. And, the estimation of a 
floor configuration in the direction in which a contact 
sensor that is not in contact with the ground is further 
likely to float may be interrupted, or the estimation of a 
floor configuration may be also interrupted when all 
contact sensors are floating. 
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[Fifth Embodiment] 

In the first to the fourth embodiments described 
above, the explanations have been given to the cases where 
5 the total number of child nodes of a node having child 
nodes is three or less have been taken as examples; 
however, also in a case where the number of child nodes is 
four or more, the concepts of the moments and inclination 
angles can be expanded as shown below by introducing the 
10 concept of a weighted average. 

The concept can be expanded for any of desired 
values, actual values, and errors. Here, therefore, the 
desired values, the actual values, and errors will not be 
discriminated; instead, the moment for a general set of 
15 ground contact portion floor reaction forces Fn (n=l , 2 , . . . ) 
will be expanded and defined as shown below. 



A set of the floor reaction forces of an n-th ground 
contact portion Fn (n=l , 2 , . . . , last leaf node number) is 
20 hierarchically relativized to determine an n-th node 

relative floor reaction force Fn_rel (n=l , 2 , . . . , las t node 
number) . 

The number of the child nodes of an n-th node is 
denoted by r. 

25 The identification number of an j-th child node of 

the n-th node is denoted by aj ( j = 1 , 2 , . . . , r ) . 

The weight of the j-th child node of the n-th node 
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is denoted by Wj ( j =1 , 2 , . . . , r ) . 

The column vector having, as a j-th element, the 
weight of the j-th child node of the n-th node is denoted 
by UWn. 

5 Thus, UWn is defined by the following expression 38, 

where "T" means transposition, and a column vector can be 
expressed by transpose a row vector. 

UWn = (Wal , Wa2 , . . . , War ) T ... Expression 38 

10 

r-1 mutually independent vectors orthogonal to the 
vector UWn (that is, the scalar product with the vector 
UWn is zero) are denoted by R(l),R(2),...,R(r-l). R ( j ) 
( j =1 , 2 , . . . , r-1 ) denotes the column vector of r row, 1 

15 column. Incidentally, R(j) ( j =1 , 2 , . . . , r- 1 ) are desirably 
orthogonal to each other, considering the ease of 
computation and control accuracy. A matrix having R(j) 
set to a j-th column ( j =1 , 2 , . . . , r-1 ) is denoted by Hn . Hn 
is the matrix of r row, r-1 column. 

20 A column vector whose j-th element ( j = 1 , 2 , . . . , r ) is 

a relative floor reaction force Faj_rel of a j-th child 
node of the n-th node is defined as an n-th group relative 
floor reaction force vector Fn_rel_c. 

In other words, Fn_rel_c is defined by the following 

25 expression 39. 

Fn_rel_c= (Fal_rel, Fa2_rel, . . . , Far_rel) T ... Expression 

39 
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Fn_rel_c denotes a column vector of r row, 1 column. 

A column vector Mn_exp satisfying the following 
expression 40 is referred to as an n-th node expansion 
floor reaction force moment. 

Fn_rel_c = Hn*Mn_exp . . . Expression 40 

Mn_exp denotes a column vector of r-1 row, 1 column. 

For the set of ground contact portion floor reaction 
forces Fn (n=l , 2 , . . . ) , the n-th node expansion floor 
reaction force moment Mn_exp is defined as described above 

More specifically, based on the ground contact 
portion floor reaction force Fn (n=l , 2 , . . . ) , a hierarchized 
node relative floor reaction force Fn_rel (n=l , 2 , . . . ) is 
determined, and further, a vector having, as its element, 
the coefficient of the linear combination when a vector 

(Fal_rel , Fa2_rel , . . . , Far_rel ) T having, as its elements, 
the relative floor reaction forces of all child nodes aj 

( j =al , a2 , . . . , ar ) of an n-th node is expressed by the liner 
combination of certain predetermined mutually independent 
vectors R ( j ) ( j =1 , 2 , . . . , r-1 ) that are orthogonal to a 
vector (Wal , Wa2 , . . . , War ) T having the weights of all child 
nodes of the n-th node as its elements, is referred to as 
the n-th node expansion floor reaction force moment Mn_exp 

Incidentally, a j-th element (the element of a j-th 
row) of the n-th node expansion floor reaction force 
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moment Mn_exp is referred to as the j-th component of the 
n-th node expansion floor reaction force moment. 

Further, the n-th node expansion floor reaction 
force moment relative to the set of actual ground contact 
portion floor reaction forces Fn (n=l , 2 , . . . ) is referred to 
as the actual n-th node expansion floor reaction force 
moment Mn_exp_act . 

Further, the n-th node expansion floor reaction 
force moment relative to the set of desired ground contact 
portion floor reaction forces Fn (n=l , 2 , . . . ) is referred to 
as the desired n-th node expansion floor reaction force 
moment Mn_exp_ref . The desired n-th node expansion floor 
reaction force moment is usually set to a zero vector. 

Further, the n-th node expansion floor reaction 
force moment relative to the set of ground contact portion 
floor reaction force errors Fn (n=l , 2 , . . . ) is referred to 
as the n-th node expansion floor reaction force moment 
error Mn_exp_err. 

Similarly, the inclination angle relative to a set 
of general ground contact portion heights Zn (n=l , 2 , . . . ) is 
expanded and defined as follows. 

A set of ground contact portion heights 
Zn (n=l , 2 , . . . , las t leaf node number) is hierarchically 
relativized to determine an n-th node relative height 
Zn_rel (n=l , 2,..., last node number) . 

A column vector whose j-th element ( j = 1 , 2 , . . . , r ) is 
a relative height Zaj_rel of a j-th child node of the n-th 
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node is defined as an n-th node relative height vector 
Zn_rel_c . 

In other words, Zn_rel_c is defined by the following 
expression 4 1 . 

Zn_rel_c= (Zal_rel, Za2_rel, . . . , Zar_rel) T ... Expression 

41 

A column vector 0n_exp satisfying the following 
expression 42 is referred to as an n-th node expansion 
floor reaction force inclination angle. 

Zn_rel_c = Hn*0n_exp . . . Expression 42 

9n_exp denotes a column vector of r-1 row, 1 column. 

More specifically, based on the ground contact 
portion height Zn (n=l , 2 , . . . ) , a hierarchized node relative 
height Zn_rel (n=l , 2 , . . . ) is determined, and further, a 
vector having, as its element, the coefficient of the 
linear combination when a vector 

(Zal_rel, Za2_rel, . . . , Zar_rel) T having, as its elements, 
the relative heights of all child nodes aj ( j =1 , 2 , . . . , r ) 
of an n-th node is expressed by the liner combination of 
certain predetermined mutually independent vectors 
R ( j ) ( j =1 , 2 , . . . , r-1 ) that are orthogonal to a vector 

(Wal , Wa2 , . . . , War ) T having the weights of all child nodes 
of the n-th node as its elements, is referred to as the n- 
th node expansion inclination angle 0n . 
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By using the expansion floor reaction force moment 
and the expansion inclination angle defined as described 
above, the compliance control and the processing for 
estimating floor configurations are expanded almost as 
they are for a case where the number of the child nodes of 
an a-th node is four or more. The following will explain 
an example thereof as a fifth embodiment. In the fifth 
embodiment, the functional construction of a control 
device of a robot is the same as that shown in the 
aforesaid Fig. 2. In this case, the functional 
construction of a hierarchical compliance operation 
determiner may be the same as that explained with 
reference to the aforesaid Fig. 35 except for a 
compensating total floor reaction force moment distributor, 
a compensating angle determiner, and a floor configuration 
estimator . 

[Expanding the processing of the compensating total floor 
reaction force moment distributor] 

For example, the processing of the compensating 
total floor reaction force moment distributor in the 
hierarchical compliance operation determiner is expanded 
as shown below. 

The expansion floor reaction force moment to be 
generated in addition to a desired n-th node expansion 
floor reaction force moment Mn_exp_rel (normally zero) to 
restore the posture of a robot is referred to as an n-th 
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node compensating expansion floor reaction force moment 
Mn_exp_dmd . 

Expression 43 given below holds between the n-th 
node compensating expansion floor reaction force moment 
5 Mn_exp_dmd and the n-th node compensating floor reaction 
force moment Mn_dmd. However, Cn_mech denotes a 
predetermined coefficient matrix (the matrix of 2 rows, r- 
1 column) determined by a desired node floor reaction 
force central point and the compliance characteristic of 
10 the mechanism of the robot. 

Mn_dmd=Cn_mech * Mn_exp_dmd . . . Expression 43 

Meanwhile, generalizing the aforesaid expression 10 
15 provides the following expression 44. 

Mdmd = SMn_dmd . . . Expression 4 4 

where S means the total sum on all n-th nodes. 

20 Hence, the compensating total floor reaction force 

moment distributor may determine the n-th node 
compensating expansion floor reaction force moment 
Mn_exp_dmd (n=l,2, . . .) and the n-th node compensating 
floor reaction force moment Mn_dmd such that expression 43 

25 and expression 44 are satisfied. 



[Expanding the processing of the compensating angle 
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determiner (0n determiner) ] 

The processing of the n-th node compensating angle 
determiner in the fifth embodiment is carried out as 
follows. For example, in the processing of the 0145 
5 determiner in the third embodiment (refer to Fig. 25 and 
Fig. 33), the processing until M145act is determined is 
replaced by the processing for determining the aforesaid 
actual n-th node expansion floor reaction force moment 
Mn_exp_act on the basis of the actual floor reaction force 

10 of each ground contact portion, 145 is replaced by n, and 

the dimension of the compensation filter, the low-pass 
filter, and gain Kn in Fig. 33 may be expanded to the 
number obtained by subtracting 1 from the number of child 
nodes of an n-th node. The compensating angle 0n of the 

15 n-th node can be determined by the processing that has 
been replaced as described above. 



[Estimating a floor configuration by using an expansion 
floor reaction force moment] 
20 As described below, the processing of the floor 

configuration estimator may partly incorporate a technique 
using the concept of the expansion floor reaction force 
moment . 

In place of the processing shown in Fig. 56 of the 
25 floor configuration estimator explained in the aforesaid 
fourth embodiment, the processing shown in the block 
diagram of Fig. 57 is used to estimate floor configuration 
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errors . 

Referring to Fig. 57, this processing will be 
explained. First, an n-th node expansion floor reaction 
force moment estimation error Mn_exp_es tm_err 
5 corresponding to an n-th ground contact portion floor 

reaction force estimation error Ffn_estm_err (n=l,2,...) 
is determined according to the definition of the expansion 
moment from the difference between the estimated n-th 
ground contact portion floor reaction force calculated as 

10 explained in conjunction with the aforesaid Fig. 56 and 

the actual floor reaction force of the n-th ground contact 
portion (the set of differences for each node) . 
Incidentally, the aforesaid vector R(j) required to 
determine the n-th node expansion floor reaction force 

15 moment estimation error is determined on the basis of the 
weight of each node. 

Subsequently, as shown in expression 45 given below, 
the n-th node expansion floor reaction force moment 
estimation error Mn_exp_estm_err is multiplied by a 

20 predetermined coefficient matrix Kn_cmpl thereby to 
determine an n-th node expansion inclination angle 
correction amount candidate value 0n_inc_cand, which is 
the candidate value of the correction amount of the n-th 
node expansion inclination angle. 

25 

0n_inc_cand = Kn_cmpl*Mn_exp_estm_err . . . Expression 

45 
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Incidentally, Kn_cmpl is not necessarily a diagonal 
matrix . 

Subsequently, a coefficient for a vector R(j) 
( j =1 , 2 , . . . r-1 ) is defined as the j-th element of 
0n_inc_cand to determine a vector obtained by linearly 
combining the vectors R(j). The determined vector is 
defined as the n-th node relative floor height error 
correction amount candidate value Zn_inc_cand, which is 
the candidate value of the correction amount of the n-th 
node relative floor height error. 

In other words, Zn_inc_cand is determined according 
to the following expression 46. 

Zn_inc_cand = Hn*9n_inc_cand ... Expression 46 

As described above, the processing for determining 
the n-th node floor reaction force estimation error 
Fn_estm_err to the n-th node relative floor height error 
correction amount candidate value Zn_inc_cand may be 
replaced from the one shown in Fig. 56 to the one shown in 
Fig. 57. 

The arithmetic processing of Fig. 57 other than the 
above is the same as the arithmetic processing of Fig. 56. 

The subroutine processing of the floor height error 
estimation processing in the fifth embodiment requires the 
processing for a case where the number of child nodes of 
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an n-th node is four or more. This processing expands the 
aforesaid floor configuration estimation processing for 
three child nodes (refer to Fig. 41), and if the ground 
contact portion corresponding to a child node j is likely 
5 to float and diverge, then the estimated j-th node 

relative floor height error Zj_rel_estm is maintained at 
the last value Z j_rel_es tm_p (the j-th node relative floor 
height error correction amount candidate value Zj_inc_cand 
is set to zero) , as with the floor configuration 

10 estimation processing for three-children nodes. Further, 
the estimated node relative floor height errors 
Zk_rel_estm of the remaining child nodes are determined 
such that they approximate the value obtained by adding a 
certain predetermined bias value c to the sum of the last 

15 estimated k-th node relative floor height error 

Zk_rel_estm_p and Zn_inc_cand. However, the bias value c 
is determined such that the weighted average of the 
estimated node relative floor height errors of all child 
nodes of the n-th node is zero. 

20 As described above, the floor configuration 

estimation processing can be expanded also when there is a 
node having four or more child nodes. However, the 
arithmetic processing will be easier if a hierarchical 
structure is determined not to include four or more child 

25 nodes rather than carrying out such processing. 

[Sixth Embodiment ] 
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Referring now to Fig. 58 to Fig. 65, a control 
device for a mobile robot according to a sixth embodiment 
of the present invention will be explained. Fig. 58 and 
Fig. 59 are side views showing a legged mobile robot 51 
5 according to the sixth embodiment (a bipedal mobile robot 

in the present embodiment), the portion of a knee joint 56, 
which will be discussed later, being in contact with a 
floor (kneeling). Incidentally, Fig. 58 schematically 
shows the robot 51 as a linear link assembly. 

10 An object of the invention related to the present 

embodiment is to stably control the posture of a robot by 
manipulating a reaction force (external force) received 
from a floor, including an object fixed on the floor, in a 
state wherein a portion, such as a knee, an elbow, or a 

15 torso other than the distal portions of the legs or arms 
of the robot is in contact with the floor or the object 
fixed (set) on the floor (an object regarded as a material 
extended from the floor) . 

More specifically, the object is to permit posture 

20 control in a state wherein the robot is kneeling or in a 
state wherein it is sitting on a chair. 

A conventional publicly known human-like robot is 
not provided with sensors for detecting floor reaction 
forces on, for example, its knees, so that it has been 

25 impossible to control the floor reaction forces acting on 
the knees. For instance, in the conventional human-like 
robot, when the robot is kneeling as shown in Fig. 58 and 
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Fig. 59, the floor reaction forces acting on the right and 
left knees are dependent on (governed by) the concavities 
and convexities of a floor, and the joint angles of legs 
have not been adjusted on the basis of the concavities and 
5 convexities of the floor. Hence, there have been some 

cases where the portions of the robot in contact with the 
floor shake due to concavities and convexities of the 
floor, leading to unstable ground contact states of the 
ground contact portions. And, in such a state, an attempt 

10 to make the robot move or work sometimes has caused 

instability of the posture of the robot. 

Further, when, for example, the robot stands up from 
the state wherein it is kneeling, there has been a danger 
of the robot falling down if an actual floor inclination 

15 is different from the inclination supposed in a desired 

gait, because the position of the center-of -gravity of the 
robot is not properly controlled and the robot tries to 
stand up with its body posture inclined. 

Further, in a case where the robot sitting on a 

20 chair operates or works while maintaining its posture 

stable, it is preferred that not only the floor reaction 
forces acting on the feet of the legs of the robot but 
also the reaction forces acting from the chair onto the 
buttocks of the robot can be properly controlled so as to 

25 restore the posture of the robot to a proper posture when 
it stands up from the chair or sits onto the chair. 

Conceptually, if an object, such as a chair, which 
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is fixedly set on a floor is considered as a part of a 
floor, then the aforesaid reaction forces may be said to 
be floor reaction forces in a broad sense. 

With the view of the problems with the conventional 
5 system as described above, the sixth embodiment solves the 

aforesaid problems, and in a state wherein portions of a 
mobile robot, such as the knees, elbows, the torso, and 
buttocks, other than the distal portions of legs or arms 
are in contact with a floor or an object considered as a 

10 material extended from the floor and subjected to reaction 
forces, it properly controls not only the reaction forces 
acting on the distal portions of the legs or arms of a 
robot but also the reaction forces acting on the portions 
other than the distal portions of the legs or arms by 

15 using the control of the hierarchical compliance described 
above, thereby making it possible to keep the posture of 
the mobile robot stable. 

The following will explain the sixth embodiment in 
more detail by taking the robot (bipedal mobile robot) 51 

20 shown in Fig. 58 and Fig. 59 as an example. 

First, the mechanical construction of the robot 51 
will be explained. In the robot 51, two legs (link 
mechanisms) 52 (one leg being not shown) are extended from 
the bottom end of a body (base) 53. Further, two arms 

25 (link mechanisms) 54 (one arm being not shown) are 

extended from upper part of the body 53. Each leg 52 is 
provided with a hip joint 55, a knee joint 56, and an 
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ankle joint 57 at its proximal portion adjacent to the 
body 53 (the portion connected to the body 53) , its middle 
portion, and its distal portion, respectively, which are 
operated by actuators, such as electric motors, and a foot 
5 58 is connected to the distal portion of each leg 52 

through the ankle joint 57. Similarly, each arm 54 is 
provided with a shoulder joint 59, an elbow joint 60, and 
a wrist joint 61 at its proximal portion adjacent to the 
body 53 (the portion connected to the body 53) , its middle 

10 portion, and its distal portion, respectively, which are 

operated by actuators, such as electric motors, and a hand 
62 is connected to the distal portion of each arm 54 
through the wrist joint 61. In this example, the joints 
55, 56, and 57 of each leg 2 are joints having, for 

15 example, 3 degrees of freedom, 1 degree of freedom, and 2 
degrees of freedom, respectively, and the foot 58 has 6 
degrees of freedom relative to the body 53. Further, the 
shoulder joint 59, the elbow joint 60, and the wrist joint 
61 of each arm 54 are constructed such that their degrees 

20 of freedom allow the hand 62 to have a degree of freedom 
of 6 degrees or more with respect to the body 53. 

Although not shown, the body 53 of the robot 51 is 
provided with a control device 50 similar to that of the 
aforesaid first embodiment. Further, a head 63 is 

25 provided at the upper end of the body 53. 

In this robot 1, in the state wherein the robot 1 is 
on its knees (particular posture state), as shown in Fig. 
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58 and Fig. 59, the portions of the foot 58 of each leg 52 
and each knee joint 56 (more specifically, the surface 
portion of a link (shank link) connecting the knee joint 
56 and the ankle joint 57 at near the knee joint 56; 
5 hereinafter it will be referred to simply as the knee) and 
the hand 62 of each arm 54 are ground contact portions. 
And, in the present embodiment, as shown in Fig. 59, the 
knee, which is a ground contact portion, is provided with 
a floor reaction force sensor 90 (load sensor) . The floor 

10 reaction force sensor 90 is constructed of a main body 

(sensor part) 92 and a soft member (elastic member) 94, 
such as a sponge. The main body 92 is fixed to the knee 
(leg link) , and the outside of the main body 92 is covered 
with a soft member (elastic member) 94. To enhance the 

15 accuracy of the compliance control in the knee, it is 

desirable to shape the surface (ground contact surface) of 
the soft member 94 into a round convex surface in addition 
to covering the knee with the soft member 94. This 
arrangement reduces the nonlinearity of the relationship 

20 between a corrective operation of a desired motion of the 
robot 51 and a floor reaction force, resulting in better 
control performance of the compliance control. 
Incidentally, although not shown, the foot 58 and the 
ankle joint 57 are connected through a floor reaction 

25 force sensor, such as a six-axis force sensor, and the 
compliance mechanism. Similarly, the hand 62 and the 
wrist joint 61 are connected through a floor reaction 
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force sensor, such as a six-axis force sensor, and the 
compliance mechanism, which are not shown. The connecting 
constructions may be ones that are publicly known. 

The floor reaction force sensor 90 of the ground 
contact portion of the knee joint may be any one of the 
following . 

1) Sensor that detects only the translational force in the 
direction perpendicular to the surface of a ground contact 
portion that comes in contact with a floor (ground contact 
surface) . 

2) Sensor that detects not only the translational force in 
the direction perpendicular to the surface of a ground 
contact portion that comes in contact with a floor (ground 
contact surface) but also the translational force in a 
direction other than the direction perpendicular to the 
contact surface. 

3) Distributed pressure sensor 

4) Sensor that detects moments in addition to 
translational forces (e.g., six-axis force sensor) 

Alternatively, a displacement sensor for detecting 
the deformation (distortion) of the aforesaid soft member 
94 may be used in place of one that directly detects a 
load . 

In the present embodiment, as the floor reaction 
force sensor 90, the sensor of the above 2) will be used. 
To further enhance the accuracy of the compliance control, 
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the sensor of the above 3) or 4) may be used as the floor 
reaction force sensor 90. Incidentally, as the structure 
of the knee, a floor reaction force sensor may be added to 
a protective pad provided with a spring (a pad for 
5 protecting the knee) , as disclosed in Japanese Unexamined 
Patent Application Publication No. 2000-62760 previously 
proposed by the present applicant. 

In the present embodiment, the hierarchical 
structure as shown in Fig. 61 is set for the robot 51 on 

10 its knees as described above. Specifically, the right 

foot 58, the left foot 58, the right knee, the left knee, 
the right hand 62, and the left hand 62 as the ground 
contact portions are associated with a first node, a 
second node, a third node, a fourth node, a fifth node, 

15 and a sixth node, respectively, which are leaf nodes. 

Further, a 12th node having the first node and the second 
node as child nodes, a 34th node having the third node and 
the fourth node as child nodes, a 56th node having the 
fifth node and the sixth node as child nodes, and a 1234th 

20 node having the 12th node and the 34th node as child nodes 
have been set as intermediate nodes. Further, a 123456th 
node having the 1234th node and the 56th node as child 
nodes has been set as the root node. Further, according 
to the policy similar to that in the aforesaid first 

25 embodiment and the like, a desired floor reaction force 
central point Qn (n=l, 2, 3, 4, 5, 6, 12, 34, 56, 1234, 123456) is 
associated with each node, as shown in the figure. 
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Incidentally, the desired floor reaction force central 
point Q123456 of the 123456th node, which is the root node, 
is identical to a desired total floor reaction force 
central point P. 
5 In the present embodiment, the control device 50 is 

supposed to have a functional construction similar to that 
shown in the aforesaid Fig. 2. 

In this case, the desired ground contact portion 
trajectory of a desired motion in a desired gait output by 

10 a gait generating device 100 in the present embodiment is 

constructed of the desired position/posture trajectory of 
each hand 62, the desired position/posture trajectory of 
each foot 58, and the desired position trajectory of each 
knee. In this case, the gait generating device 100 

15 preferentially determines desired foot positions/postures 
(desired first and second ground contact portion 
positions/postures) , desired hand posit ions /postures 
(desired fifth and sixth ground contact portion 
positions/postures ) , and desired knee positions (desired 

20 third and fourth ground contact portion positions) so that 
the feet 58, the hands 62, and the knees come in contact 
with the ground on a supposed floor surface as required 
for the gait, then determines a desired ZMP (desired total 
floor reaction force central point) in a supporting 

25 polygon, which is a minimum convex polygon that includes 
the desired ground contact point (or a desired ground 
contact line or a desired ground contact surface) of each 
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ground contact portion, and then further determines 
desired body position/posture by using a dynamic model of 
the robot 1 such that the desired foot positions/postures, 
the desired hand positions/postures, the desired knee 
5 positions, and the desired ZMP are satisfied. 

If the head 63 can be moved with respect to the body 
53, then the desired position/posture trajectory of the 
head 63 is included in a desired motion. 

In the present embodiment, the arithmetic processing 

10 of the robot geometric model (inverse kinematics 

calculator) 110 shown in Fig. 2 differs from that of the 
first to the third embodiments, as will be discussed later. 

Further, in the present embodiment, a part of the 
processing technique of a hierarchical compliance 

15 operation determiner 114 differs from the one explained in 
the first to the third embodiments described above. Fig. 
62 shows the functional construction of the hierarchical 
compliance operation determiner 114 of the present 
embodiment. In the processing of this functional 

20 construction, major aspects that are different from the 
first to the third embodiments will be explained. A 
compensating total floor reaction force moment distributor 
114a determines and outputs not only the node compensating 
floor reaction force moments of the intermediate nodes and 

25 the root node, but also a node compensating floor reaction 
force moment Mn_dmd of an n-th node (n=l,2,5,6) of the 
leaf nodes, that is, the required floor reaction force 
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moment (the required moment for restoring the posture) 
about a desired n-th ground contact portion floor reaction 
force central point (n=l,2,5,6) . This is because, in the 
robot 51, moments can be generated about the desired floor 
reaction force central points of the feet 58 and the hands 
62 as the ground contact portions. The technique for 
determining the node compensating floor reaction force 
moment Mn_dmd, including the required moments, may be the 
same technique explained in the first and the second 
embodiments described above. Further, in the present 
embodiment, the compensating total floor reaction force 
moment distributor 114a determines and outputs a corrected 
desired n-th ground contact portion floor reaction force 
moment Mn_refmdf d (n=l , 2 , 5, 6) about a desired n-th ground 
contact portion floor reaction force central point 
(n=l,2,5,6), which is corrected by generating a node 
compensating floor reaction force moment about the desired 
floor reaction force central point of each corresponding 
node, together with a translational force component 
Fn_refmdfd (n=l, 2, 3, 4, 5, 6) of a corrected desired ground 
contact portion floor reaction force. These are used by a 
deformation compensation amount calculator 114n to 
calculate a deformation compensation amount. 

A compensating angle determiner (the part enclosed 
by the virtual line in Fig. 62) in the present embodiment 
determines and outputs not only the compensating angles of 
the intermediate nodes and the root node but also the node 
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compensating angle 0n of an n-th node (n=l,2,5,6) among 
the leaf nodes. A 0n determiner that determines these n- 
th node compensating angles 0n (n=l , 2 , 5 , 6) determines an n- 
th node compensating angle 0n (n=l, 2, 5, 6) by the same 
5 processing as that of the foot compensating angle 
determiner disclosed in Japanese Unexamined Patent 
Application Publication No. H10-277969. Incidentally, the 
technique for determining the compensating angles 
0n (n=12, 34, 56, 1234, 123456) of the intermediate nodes and 

10 the root node other than the above nodes may be the same 

as the technique explained in the first and the second 
embodiments described above. 

Further, a corrected desired ground contact portion 
position/posture calculator 114g in the present embodiment 

15 combines node rotational manipulations on the basis of 
each n-th node compensating angle 

0n (n=12, 34, 56, 1234, 123456) by the technique explained in 
the first and the second embodiments described above so as 
to correct a desired ground contact portion position, and 

20 it further corrects the desired posture of an n-th ground 
contact portion (n=l,2,5,6), thereby determining the 
corrected desired ground contact portion position/posture 
of each ground contact portion. 

Further, according to the present embodiment, a 

25 floor configuration estimator 130 determines an estimated 
n-th floor height error Zf n_estm (n=l , 2 , 3 , 4 , 5 , 6 ) by the 
same technique as the technique explained in the aforesaid 
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third embodiment and also estimates a ground contact 
portion floor inclination error of an n-th ground contact 
portion 0f n (n=l , 2 , 5 , 6) . The estimation of the ground 
contact portion floor inclination error Gfn is performed 
5 by the same processing as the processing for estimating 
foot floor inclinations by the floor configuration 
estimator disclosed in Japanese Unexamined Patent 
Application Publication No. H10-277969. 

The processing techniques of the functional 
10 construction of the hierarchical compliance operation 

determiner 114 of the present embodiment other than the 
ones described above are the same as that in the third 
embodiment . 

Except for the different aspects explained above, 
15 the arithmetic processing of the control device 50 in the 
present embodiment is the same as that in the first to the 
third embodiments . 

Next, the processing of the aforesaid robot 
geometric model 110 in the present embodiment will be 
20 explained in detail. 

In the robot 51 of the present embodiment, the 
number of the degrees of freedom of the joints from the 
body 53 to the knees is limited to three (only 3 degrees 
of freedom in the hip joints 55); therefore, it is 
25 impossible to change only the difference in height between 
the right and left knees while strictly maintaining body 
position/posture, foot position/posture, the horizontal 



- 293 - 



positions of the right and left knees, and the sum of the 
heights of the right and left knees at their desired 
values. In other words, if an attempt is made to forcibly 
change only the height difference between the right and 
5 left knees, then a twist or slippage would inconveniently 

take place between ground contact portions (namely, the 
knees and the feet) and a floor. 

Similarly, it is impossible to change only the 
difference in height between the right and left feet while 

10 strictly maintaining the body position/posture, the 

positions of both knees, the horizontal positions of both 
feet, and the sum of the heights of the right and left 
feet at their desired values. In other words, if an 
attempt is made to forcibly change only the height 

15 difference between the right foot and left foot, then a 

twist or slippage would inconveniently take place between 
a ground contact portion (namely, a knee and a foot) and a 
floor . 

Similarly, it is impossible to change only the sum 
20 of the heights of the right and left knees while strictly 
maintaining the body position/posture, foot 

positions/postures, the horizontal positions of the right 
and left knees, and the height difference between the 
right and left knees at their desired values. In other 
25 words, if an attempt is made to forcibly change only the 
sum of the heights of the right and left knees, then the 
body position would be dislocated from a desired position 
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even though a twist or slippage may not take place between 
ground contact portions (namely, the knees and the feet) 
and a floor. As a result, the position of the total 
center-of -gravity of the robot 51 and an inertial force 
5 will deviate from desired values, leading to deteriorated 
stability of the robot 51. 

This means that, in any case, the corrected desired 
ground contact portion position/posture with deformation 
compensation and desired body position/posture that have 

10 been determined by the hierarchical compliance operation 
determiner 114 cannot be strictly satisfied at the same 
time, so that a twist or slippage takes place between the 
feet 58 or the knees of the robot 51 and the floor or the 
total center-of -gravity of the robot 51 and an inertial 

15 force deviate from their desired values, possibly 

resulting in deterioration of the stability of the robot 
51 when the robot 51 is in the posture state shown in Fig. 
58 and Fig. 59. Incidentally, the hands 62 among the 
ground contact portions have a degree of freedom of 6 

20 degrees or more of freedom with respect to the body 53; 
therefore, no twist or slippage will occur between the 
hands 62 and the floor unless the robot 51 is made to take 
a posture in which coming into contact with the floor 
through portions other than the hands 62 of the arms 54. 

25 Hence, in the present embodiment, the posture or the 

position/posture of the body 53 are corrected on the basis 
mainly of a change in the height difference between the 
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right and left knees while restraining, as much as 
possible, the occurrence of a twist or slippage between 
the knees and the feet 58 among the ground contact 
portions of the robot 51 and the floor and also 
5 restraining, as much as possible, a change in the position 
of the center-of -gravity (especially the horizontal 
position) of the body 53. 

Figs. 63(a) and (b) show examples of the operations 
for correcting the posture of the body 53. Fig. 63(c) 

10 will be discussed later. These Figs. 63(a), (b) , and (c) 
omit showing the arms 54 and the head 63. 

One of the operations for correcting the posture of 
the body 53 is the operation in which, from the state 
wherein the robot 51 is kneeling as shown in Fig. 63(a), 

15 the body 53 is rotated (rotated as indicated by an arrow 
yl) by using, as the axis of rotation, the trunk axis 
passing approximately the center-of -gravity G of the body 
53, as shown in Fig. 63(b), on the basis of a change in 
the height difference between the right and left knees 

20 caused by compliance control. 

Further, in the posture in which the robot 51 is 
kneeling, as shown in Fig. 63, a change in the height 
difference between the right and left feet 58 and 58 
causes the height difference between the right and left 

25 knees to change by about half the change in the height 
difference between the right and left feet 58 and 58. 
Hence, the same operation as that of correcting the 
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posture of the body 53 on the basis of a change in the 
height difference between the right and left knees is 
performed by only a half amount, as compared with the case 
of a change in the height difference between the right and 
5 left feet, on the basis of a change in the height 

difference between the right and left feet 58 and 58 
caused by the compliance control. 

Further, when correcting the posture of the body 53 
as described above, the position and the posture of the 

10 body 53 are corrected on the basis of a change in the sum 
of the heights of the right and left knees caused by the 
compliance control while restraining the occurrence of a 
twist or slippage between ground contact portions (the 
knees and the feet 58) and the floor as much as possible, 

15 and also restraining, as much as possible, a change in the 
position (especially the horizontal position) of the 
center-of -gravity G of the body 53 or in the inclination 
of a segment connecting the center-of -gravity G and a 
total floor reaction force central point. 

20 Fig. 64 visually shows an operation for correcting 

the position and the posture of the body 53 on the basis 
of changes in the sum of the heights of the right and left 
knees. Specifically, from the posture of the robot 51 
indicated by the dashed lines, as both knees are operated 

25 to move down by the compliance control to the posture of 
the robot 51 indicated by the solid lines, the bottom end 
portion (or the waist) of the body 53 is shifted forward, 



- 297 - 



as indicated by an arrow y3, and the inclination of the 
body 53 is shifted backward (in the direction in which the 
body 53 rises), as indicated by an arrow y2 . In other 
words, the body 53 is tilted backward while maintaining 
5 the position of the center-of -gravity G of the body 53 (or 
the position of a predetermined representative point of 
the body 53), especially the horizontal position thereof. 
Alternatively, the body 53 is tilted backward while 
maintaining the inclination of the segment connecting the 

10 center-of -gravity G and the desired total floor reaction 

force central point P. Further, as an operation for 
raising both knees is performed by the compliance control, 
the bottom end portion (or the waist) of the body 53 is 
shifted backward, inversely from the above, to shift the 

15 inclination of the body toward the front. In other words, 

the body 53 is tilted forward while maintaining the 
position of the center-of -gravity G of the body (or the 
position of the predetermined representative point of the 
body), especially its horizontal position. Alternatively, 

20 the body 53 is tilted backward while maintaining the 
inclination of the segment connecting the center-of- 
gravity G and the desired total floor reaction force 
central point P. Incidentally, Ql" and Q3" in Fig. 64 
denote the desired floor reaction force central point of 

25 the foot 58 and the desired floor reaction force central 
point of the knee, respectively, after the 
position/posture of the body 53 have been corrected as 
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described above. In this example, Ql" is identical to a 
desired floor reaction force central point Ql of the foot 
58 before the correction. 

The above is the overview of the operation for 
5 correcting the posture and the position of the body 53. 

The processing function of the robot geometric model 
(inverse kinematics calculator) 110 in the present 
embodiment is shown by the block diagram of Fig. 65. 
The inverse kinematics calculator 110 first 

10 determines the correction amount of the height difference 
between the right and left knees Zkneedif f mdf d and the 
correction amount of the sum of the heights of the right 
and left knees Zkneesummdfd for the desired positions of 
the right and left knees determined by the gait generating 

15 device 100, and the correction amount of the height 
difference between the right and left feet 58 and 58 
Zf ootdif f mdf d for the desired positions of the right and 
left feet determined by the gait generating device 100 on 
the basis of the corrected desired n-th ground contact 

20 portion position/posture with deformation compensation 
(n=l , 2 , . . . , 6) and the desired ground contact portion 
positions/postures of the feet 58 and the knees determined 
by the gait generating device 100. 

Specifically, the correction amount of the height 

25 difference between the right and left knees Zkneedif f mdf d, 
the correction amount of the sum of the heights of the 
right and left knees Zkneesummdfd, and the correction 
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amount of the height difference between the right and left 
feet Zf ootdif f mdf d are determined according to the 
following expressions 47, 48, and 49. 

5 Zkneedif f mdf d 

= Corrected desired fourth ground contact portion position 
with deformation compensation 

- Desired fourth ground contact portion position 

- Corrected desired third ground contact portion position 
10 with deformation compensation 

+ Desired third ground contact portion position 

. . . Expression 47 

Zkneesummdf d 

15 = Corrected desired fourth ground contact portion position 
with deformation compensation 

- Desired fourth ground contact portion position 

+ Corrected desired third ground contact portion position 
with deformation compensation 
20 - Desired third ground contact portion position 

. . . Expression 48 

Zf ootdif fmdfd 

= Corrected desired second ground contact portion position 
25 with deformation compensation 

- Desired second ground contact portion position 

- Corrected desired first ground contact portion position 
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with deformation compensation 

+ Desired first ground contact portion position 

. . . Expression 49 



5 More precisely, "portion position" in expressions 47 

to 4 9 is the height component (the component in the 
vertical direction) of the portion position. 

Subsequently, the body position/posture correction 
amount is determined on the basis of the correction amount 

10 of the height difference between the right and left knees 

Zkneedif f mdf d, the correction amount of the sum of the 
heights of the right and left knees Zkneesummdf d, and the 
correction amount of the height difference between the 
right and left feet Zf ootdif f mdf d . 

15 The body position/posture correction amount is 

composed of a body position correction amount for knee 
height difference Xbkneedif f mdf d, a body posture 
correction amount for knee height difference 

0bkneedif f mdf d, a body position correction amount for knee 
20 height sum Xbkneesummdf d, a body posture correction amount 
for knee height sum Gbkneesummdf d, a body position 
correction amount for foot height difference 
Xbf ootdif f mdf d, and a body posture correction amount for 
foot height difference 9b f ootdif f mdf d . Specifically, 
25 these values are determined as follows. 

First, based on the correction amount of the height 
difference between the right and left knees Zkneedif f mdf d, 
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the body position correction amount for knee height 
difference Xbkneedif f mdf d and the body posture correction 
amount for knee height difference Gbkneedif f mdf d for 
preventing the correction amount of the height difference 
5 between the right and left knees Zkneedif f mdf d from 
causing a twist or slippage between ground contact 
portions (the knees and the feet 58) and a floor are 
determined by geometric calculation on the basis of the 
correction amount of the height difference between the 
10 right and left knees Zkneedif f mdf d and the desired posture 

(desired motion) of the robot 51 at that instant (current 
time) . 

To be more specific, for example, Xbkneedif f mdf d and 
Gbkneedif f mdf d are determined according to the following 
15 expression 50, where Kxkneediff and Kthkneediff denote 

proportional coefficients based on desired postures of the 
robot 51 . 

Xbkneedif f mdf d = Kxkneedif f * Zkneedif f mdf d 
20 Gbkneedif fmdfd = Kthkneedif f *Zkneedif f mdf d 

. . . Expression 50 

As an alternative, the relationship between the 
correction amount of the height difference between the 
25 right and left knees (or a 34th node compensating angle 
G34) and the correction amounts of the body 
position/posture may be determined beforehand for some 
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representative desired postures of the robot 51, and it 
may be stored as a map or function so as to determine 
Xbkneedif f mdf d and Gbkneedif f mdf d on the basis of the map 
or function and the correction amount of the height 
5 difference between the right and left knees Zkneedif f mdf d . 
Incidentally, in the present embodiment, the body posture 
is corrected by rotating the body 53 about its trunk axis 
on the basis of the correction amount of the height 
difference between the right and left knees, so that the 

10 body position correction amount for knee height difference 
Xbkneedif f mdf d may be zero. 

Next, in the same manner as described above, based 
on the correction amount of the height difference between 
the right and left feet 58 and 58 Zf ootdif f mdf d, the body 

15 position correction amount for foot height difference 

Xbf ootdif f mdf d and the body posture correction amount for 
foot height difference 8b f ootdif f mdf d for preventing the 
correction amount of the height difference between the 
right and left feet 58 and 58 Zf ootdif f mdf d from causing a 

20 twist or slippage between ground contact portions (the 
knees and the feet 58) and a floor are determined by 
geometric calculation on the basis of the correction 
amount of the height difference between the right and left 
feet Zf ootdif f mdf d and the desired posture (desired 

25 motion) of the robot 51 at that instant (current time) . 

To be more specific, for example, Xbf ootdif f mdf d and 
6b f ootdif f mdf d are determined according to the following 
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expression 51, where Kxfootdiff and Kthfootdiff denote 
proportional coefficients based on desired postures of the 
robot 51. As described above, the influence of the height 
difference of the feet 58 is about half the influence of 
5 the height difference of the knees, so that Kxfootdiff and 
Kthfootdiff are one half of Kxkneediff and Kthkneediff . 



Xbf ootdif fmdfd = Kxf ootdif f *Zf ootdif f mdf d 
9bf ootdif fmdfd = Kthf ootdif f*Zf ootdif fmdfd 
10 ... Expression 51 



Incidentally, in the present embodiment, the body 
posture is corrected by rotating the body 53 about its 
trunk axis on the basis of the correction amount of the 

15 height difference between the right and left feet 58 and 
58, so that the body position correction amount for foot 
height difference Xbf ootdif fmdfd may be zero. 

Subsequently, in the same manner as described above, 
based on the correction amount of the sum of the heights 

20 of the right and left knees Zsummdfd, the body position 
correction amount for knee height sum Xbsummdfd and the 
body posture correction amount for knee height sum 
Gbsummdfd for preventing the correction amount of the sum 
of the heights of the right and left knees Zsummdfd from 

25 causing a twist or slippage between ground contact 
portions (the knees and the feet) and a floor are 
determined by geometric calculation on the basis of the 



- 304 - 



correction amount of the sum of the heights of the right 
and left knees Zsummdfd and the desired posture of the 
robot 51 at that instant (current time) . 

Alternatively, the relationship between the 
5 correction amount of the sum of the heights of the right 
and left knees and the correction amount of the body 
posture may be determined beforehand for some 
representative desired postures, and it may be stored as a 
map or function so as to determine Xbsummdfd and 0bsummdfd 

10 on the basis of the map or function and the correction 

amount of the sum of the heights of the right and left 
knees Zsummdfd. 

Alternatively, the correction amounts of body 
position/posture may be determined as follows. The height 

15 difference between the right and left knees is converted 
into the 34th node compensating angle 034 that causes the 
difference, the sum of the heights of the right and left 
knees is converted into the 1234th node compensating angle 
01234, and the height difference between the right and 

20 left feet is converted into the 12th node compensating 
angle 012 that causes the difference. Then, based on 
these converted compensating angles, the body 
position/posture correction amounts may be determined by 
geometric calculation. Alternatively, the relationship 

25 between the converted compensating angles and body 

position/posture correction amounts may be determined 
beforehand for some representative desired postures of the 
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robot 51, and it may be stored as a map or function so as 
to determine body position/posture correction amounts on 
the basis of the map or function and the converted 
compensating angles . 
5 Subsequently, the desired body position/posture are 

moved (rotational movement and parallel movement) by the 
body position/posture correction amounts to determine 
desired body position/posture with correction. 
Specifically, the desired body position/posture are 

10 rotationally moved about a trunk axis (or a predetermined 

axis of rotation (the axis of rotation substantially in a 
vertical plane) ) by the sum of the body posture correction 
amount for knee height difference and the body posture 
correction amount for foot height difference 

15 (Gbkneedif f mdf d + 0bf ootdif f mdf d) , and this is further 

rotationally moved about a lateral axis by the body 
posture correction amount for the sum of knee heights 
0b f ootsummdf d, then this is further moved in parallel in 
the longitudinal direction of the robot 51 by the sum of 

20 the body position correction amount for knee height 

difference, the body position correction amount for the 
sum of knee heights, and the body position correction 
amount for foot height difference (Xbkneedif f mdf d + 
Xbkneesummdf d + Xbf ootdif f mdf d) thereby to determine 

25 desired body position/posture with a twist correction. 
Subsequently, based on the desired body 
position/posture with twist correction and desired n-th 
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ground contact portion position/posture with deformation 
compensation (n=l , 2 , . . . , 6) , a joint displacement command 
of the robot 51 is determined. 

Thus, the processing of the inverse kinematics 
5 calculator 110 is carried out as described above. 

In other words, according to the sixth embodiment, 
if the degree of freedom is geometrically insufficient for 
the operation of correcting the ground contact portion 
positions/postures of the robot 51, then the hierarchical 

10 compliance operation corrects not only the desired ground 

contact portion positions /postures but also the desired 
body positions/postures such that a point of the body 
position (the representative point of the body) or the 
point (e.g., the overall center-of -gravity) of the 

15 weighted average position of a plurality of portions, 

including the body (the weight in this case is desirably 
the mass ratio of each portion) , especially the horizontal 
position of the point is maintained, or the angle of a 
line that connects the point and a desired total floor 

20 reaction force central point (desired ZMP) is maintained 
at the angle in a desired gait. 

Further, in other words, the sixth embodiment is 
provided with a means that gives priority to the 
controllability of an actual floor reaction force moment 

25 generated about a desired total floor reaction force 

central point (desired ZMP) and determines at least either 
a compensating height or a compensating angle as the 
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manipulated variable of the relative height or the 
inclination angle of a predetermined ground contact 
portion A (a knee in this case) or the manipulated 
variable of the relative height or the inclination angle 
5 of a node having a predetermined ground contact portion A 
as a descendant node in order to enhance the stability of 
the entire posture control of the robot 51, a means for 
determining the correction amount of at least either the 
posture or the position of the body while maintaining the 

10 position of the body or the aforesaid weighted average 

position of a plurality of portions, including the body, 
at approximately the position in a desired gait on the 
basis of at least either the aforesaid compensating height 
or compensating angle, and an inverse kinematics 

15 calculating means for determining a joint displacement on 
the basis of at least either the position or the posture 
of a predetermined ground contact portion B (foot in this 
case) except for the aforesaid predetermined ground 
contact portion A and the body position/posture corrected 

20 by the aforesaid correction amount. 

Incidentally, in the sixth embodiment, instead of 
rotating a body posture about the trunk axis of the body 
53 of the robot 51, the body 53 may be rotated using the 
vertical axis as the axis of rotation and using the waist 

25 (the bottom end portion of the body 53) of the robot 51 as 

the center, as shown in Fig. 64(c) . In this case, however, 
the deviation of the center-of -gravity G of the body 53 in 
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the lateral direction would increase. Alternatively, the 
body posture may be rotated using an axis located midway 
between the trunk axis of the body 53 and the vertical 
axis as the axis of rotation. Alternatively, the position 
5 and the posture of the body 53 may be simultaneously 

corrected on the basis of the correction amount of the 
height difference between both knees or the correction 
amount of the height difference between both feet 58 and 
58. Further, instead of maintaining the position of the 

10 center-of -gravity G of the body 53 unchanged, the 

position/posture of the body 53 may be corrected such that 
the overall center-of -gravity position of the robot 51 or 
the position of the representative point of the body 53 
remain unchanged. 

15 In any case, if the degree of freedom is 

geometrically insufficient in the operation for correcting 
the position/posture of a ground contact portion of the 
robot 51 by the compliance operation or the like, at least 
either the position or the posture of the body 53 may be 

20 corrected from the position/posture of a desired gait so 
as to restrain the occurrence of a slippage, such as a 
twist, of a ground contact portion. Further, instead of 
correcting at least either the position or the posture of 
the body 53, at least either the position or the posture 

25 of a predetermined portion other than the body 53 may be 
corrected . 
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[ Seventh Embodiment ] 

An explanation will now be given about a control 
device for a mobile robot according to a seventh 
embodiment of the present invention. 

In the sixth embodiment, the position/posture of the 
body have been corrected in order to prevent a slippage, 
such as a twist, of a ground contact portion and to 
minimize the deviations of the position of the overall 
center-of -gravity of the robot 51 and an inertial force. 
In the present embodiment (the seventh embodiment) , a 
slippage, such as a twist, of a ground contact portion has 
been allowed to a certain extent, and a joint displacement 
(the displacement between a hip joint 55 and a knee joint 
56) or the position/posture of a ground contact portion 
have been preferentially corrected so as to restrain the 
deviations of the position of the overall center-of- 
gravity of the robot 51 and an inertial force. 

More specifically, in the present embodiment, an 
inverse kinematics calculator 110 carries out the 
processing shown by the block diagram of Fig. 66 in place 
of the processing of Fig. 65 explained in the sixth 
embodiment. Except for this difference, the present 
embodiment is the same as the sixth embodiment. 

The inverse kinematics calculator 110 of the present 
embodiment will be explained with reference to Fig. 66. 
First, based on corrected desired n-th ground contact 
portion position/posture with deformation compensation 
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(n=l, 2, . . . , 6) (specif ically, the position out of the 
position/posture) and desired n-th ground contact portion 
position/posture (n=l, 2, . . . , 6) (specifically, the position 
out of the position/posture) , a correction amount of the 
5 height difference between the right and left knees 

Zkneedif f mdf d, a correction amount of the sum of the 
heights of the right and left knees Zkneesummdf d, and a 
correction amount of the height difference between the 
right and left feet Zf ootdif f mdf d are determined according 

10 to the aforesaid expression 47, expression 48, and 

expression 49, and further, the height difference between 
the right and left knees is converted into a 34th node 
compensating angle 034 that causes the difference. 
Similarly, the sum of the heights of the right and left 

15 knees is converted into a 1234th node compensating angle 
01234 that causes the sum, and the height difference 
between the right and left feet is converted into a 12th 
node compensating angle 012 that causes the difference. 
Next, based on the converted node compensating 

20 angles, joint displacement correction amounts are 

determined. This is performed as follows. First, a case 
is assumed where a joint displacement is corrected while 
fixing the body position/posture of a desired gait and 
retaining the angle of a segment that connects a desired 

25 total floor reaction force central point (a desired 

123456th node floor reaction force central point (point P 
in Fig. 61)) and the overall center-of -gravity of the 
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robot 51 (or the center-of -gravity of the body or the 
center-of -gravity of a plurality of portions, including 
the body 53) unchanged. In this case, a j-th joint 
displacement correction amount ( j =1 , 2 , . . . , total number of 
5 joints) for the inclination angle (compensating angle) of 
an n-th node (n=12 , 34 , 1234 ) corresponding to each of 
ground contact portions (a knee and foot 58) to become a 
unit perturbation amount is determined, and this is 
defined as a sensitivity Ln_j of the j-th joint 

10 displacement relative to the n-th node compensating angle. 
More generally, the j-th joint displacement 
correction amount ( j =1 , 2 , . . . , total number of joints) for 
the relative angle between the segment connecting a 
desired total floor reaction force central point (a 

15 desired 123456th node floor reaction force central point) 
and an overall center-of -gravity of the robot 51 (or the 
center-of -gravity of the body or the center-of -gravity of 
a plurality of portions, including the body 53) and the 
inclination angle of an n-th node (n=12 , 34 , 1234 ) 

20 corresponding to each of ground contact portions (a knee 
and the foot 58) to become a unit perturbation amount is 
determined when a joint displacement of a desired gait has 
been corrected, and this is defined as a sensitivity Ln_j 
of the j-th joint displacement relative to the n-th node 

25 compensating angle. 

Specifically, if Ln_knee_r denotes the sensitivity 
of a right knee joint displacement relative to an n-th 
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node compensating angle (n=12 , 34 , 1234 ) , Ln_knee_l denotes 
the sensitivity of a left knee joint displacement relative 
to the n-th node compensating angle, Ln_hip_r denotes the 
sensitivity of a right hip pitch joint displacement 
5 relative to the n-th node compensating angle, and Ln_hip_l 
denotes the sensitivity of a left hip pitch joint 
displacement relative to the n-th node compensating angle, 
then each sensitivity is set according to the following 
expression 52 in the posture of the robot 51 on its knees 
10 shown in Fig. 58 and Fig. 59. 

L12 34_hip_r=0, LI 2 34_hip_l=0 , LI 2 3 4_knee_r=l , 
L12 34_knee_l=l, L12_hip_r=0, L12_hip_l=0 
L12_knee_r=al2, L12_knee_l = -al2 , L34_hip_r=a34 

15 L34_hip_l = -a34, L34_knee_r=0 , L34_knee_l = 0 

. . . Expression 52 
where al2 and a34 denote predetermined constants. 

Subsequently, joint displacement correction amounts 
are determined according to expressions 53 to 56 given 

20 below, where 9knee_r denotes a right knee joint 

displacement correction amount, 0knee_l denotes a left 
knee joint displacement correction amount, 6hip_r denotes 
a right hip joint displacement correction amount (more 
specifically, the joint displacement correction amount in 

25 the pitch direction of the right hip joint), and 0hip_l 
denotes a left hip joint displacement correction amount 
(more specifically, the joint displacement correction 
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amount in the pitch direction of the right hip joint) . 



0knee_r=L12 3 4_knee_r*012 3 4+L12_knee_r*012 
+ L34_knee_r*634 

5 

0knee_l=L12 3 4_knee_l*012 3 4+L12_knee_l*012 
+ L34_knee_l*634 

9hip_r=L12 3 4_hip_r*ei2 34+L12_hip_r*ei2 
10 + L34_hip_r*034 

0hip_l=L12 3 4_hip_l*012 34+L12_hip_l*012 
+ L34 hip 1*034 



15 



Expression 53 



Expression 54 



Expression 55 



Expression 56 



Other joint displacement correction amounts are 
determined in the same manner; however, it will be omitted 
to simplify the explanation. 

For the 1234th compensating angle 01234, the 

20 displacements (angles) of both knee joints 56 are 

corrected by the same amount as 01234, as shown in Fig. 67 
Further, for the 12th compensating angle 012, the 
displacement (angle) of the right knee joint 56 is 
corrected in proportion to 012 and also the displacement 

25 (angle) of the left knee joint 56 is corrected at the same 

time by the amount obtained by multiplying the correction 
amount of the displacement of the right knee joint 56 by - 
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1. In other words, the displacement (angle) of the right 
knee joint 56 is corrected, as shown in Fig. 67, and the 
displacement (angle) of the left knee joint 56 is 
corrected in reverse therefrom. Further, for the 34th 
5 compensating angle 034, the displacement (angle) of the 

right hip joint 55 in the pitch direction is corrected in 
proportion to 934 and also the displacement (angle) of the 
left hip joint 55 in the pitch direction is corrected at 
the same time by the amount obtained by multiplying the 

10 correction amount of the displacement of the right hip 

joint 55 in the pitch direction by -1. In other words, 
the displacement (angle) of the right hip joint 55 in the 
pitch direction is corrected, as shown in Fig. 68, and the 
displacement (angle) of the left hip joint 55 in the pitch 

15 direction is corrected in reverse therefrom. Incidentally, 
Ql and Ql" in Fig. 67 denote a desired floor reaction 
force central point of the foot 58 before the corrections 
of the joint displacements described above and a desired 
floor reaction force central point of the foot 58 after 

20 the corrections, respectively. Further, Q3 and Q3" in Fig. 

68 denote a desired floor reaction force central point of 
a knee before the corrections of the joint displacements 
described above and a desired floor reaction force central 
point of the knee after the corrections, respectively. 

25 By correcting joint displacements as described above, 

the relative angle between the segment connecting a 
desired total floor reaction force central point (a 
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desired 123456th node floor reaction force central point) 
and the overall center-of -gravity of the robot 51 (or the 
center-of -gravity of the body or the center-of -gravity of 
a plurality of portions, including the body 53) and the 
5 inclination angle of an n-th node (n=12 , 34 , 1234 ) 

corresponding to ground contact portions (a knee and the 
foot 58) is changed by the aforesaid converted node 
compensating angles 012, 023, and 01234. Thus, an actual 
floor reaction force is faithfully controlled, leading to 

10 improved posture stability and ground contact properties 

of the robot 51 . 

Instead of directly correcting joint displacement 
commands (desired joint displacements) as described above, 
preferentially corrected desired ground contact portion 

15 posit ions /postures , which are the corrected desired 
positions/postures of the ground contact portions 
(specifically, the feet 58 and the hands 62) whose 
positions/postures are to be preferentially corrected to 
cause approximately the same desired joint displacements 

20 may be determined, and then, based on the determined 

preferentially corrected desired ground contact portion 
positions/postures, joint displacement commands may be 
determined by inverse kinematics calculation. 

Because of insufficient degrees of freedom of joints, 

25 it is impossible to determine joint displacements by the 
inverse kinematics calculation to satisfy desired body 
position/posture and all corrected desired ground contact 



portion posit ions /postures ; therefore, when carrying out 
the inverse kinematics calculation, some corrected desired 
ground contact portion posit ions /postures out of all 
corrected desired ground contact portion 

positions/postures are used. The some corrected desired 
ground contact portion posit ions /postures are referred to 
as the aforesaid preferentially corrected desired ground 
contact portion positions /postures . 

For example, in the situation shown in Fig. 67, for 
the 1234th node compensating angle 01234, the position 
obtained by rotationally moving a desired foot position 
about a knee may be determined as the preferentially 
corrected desired foot position. 

Incidentally, in the sixth embodiment and the 
seventh embodiment, as an example, the compliance 
operation in the situation wherein the robot 51 is 
kneeling has been explained. The following will describe 
the adaptation to a compliance operation in a situation 
wherein the robot is sitting on a chair. This will be 
explained as an eighth embodiment. 

[Eighth Embodiment ] 

Fig. 70 shows the construction of an essential 
section of a robot according to the present embodiment. 
This robot 71 is provided with floor reaction force 
sensors 73 and 73 for detecting floor reaction forces 

(load sensors, such as six-axis force sensors) at the 
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right and left, respectively, of the base end surface of 
buttocks 72. Instead of providing the floor reaction 
force sensors 73 and 73 at the right and left, a single 
floor reaction force sensor that detects the resultant 
5 force of the forces applied to the right and left of the 

base end surface of the buttocks 72 may be provided. 

In this case, the outsides of the floor reaction 
force sensors 73 and 73 are covered with a soft member 
(elastic member) 74, such as a sponge, as illustrated. To 

10 enhance the accuracy of the compliance control in the 
ground contact portions of the buttocks 72, it is 
desirable to shape the surface (ground contact surface) of 
the soft member (elastic member) 74 into a round convex 
surface in addition to covering them with the soft member. 

15 It is desirable to provide the member 74 such that the 
horizontal positions of the detection positions of the 
floor reaction force sensors 73 and 73 (the positions of 
the sensor main bodies) are aligned with the horizontal 
position of the apex of the convex surface of the 

20 aforesaid member 74 especially when the robot 71 is 
sitting on a chair through the intermediary of its 
buttocks 72. This arrangement reduces the nonlinearity of 
the relationship between a corrective operation of the 
position/posture of a ground contact portion of the robot 

25 71 and a floor reaction force, resulting in better control 
performance of the compliance control of the robot 71. 

In the robot 71, legs (link mechanisms) 52 and 55 
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are provided extendedly from the right and left sides of 
the buttocks 72. The structures of the legs 55 and 55, 
including their joints, are the same as those of, for 
example, the aforesaid sixth embodiment. Hence, the same 
5 reference marks as those related to the legs 5 and 55 in 
the sixth embodiment will be used, and the explanations 
thereof will be omitted. However, in the present 
embodiment, the knees of the legs 55 may not be provided 
with floor reaction force sensors. 

10 Further, as shown in the figure, a torso (body) 77 

is provided on the upper side of the buttocks 72, and arms 
79 and 79 are provided extendedly from both sides of the 
upper portion of the torso 77 through the intermediary of 
shoulder joints 78 and 78. Incidentally, the arms 79 may 

15 have the same structure as that in the robot 51 of the 
aforesaid sixth embodiment. Further, the torso 77 is 
connected with the buttocks 72 through the intermediary of 
a joint 80. In this case, the joint 80 is constructed of 
a torso turning joint 80a for turning the torso 77 in the 

20 yaw direction relative to the buttocks 72, and a torso 
flexing joint 80b for tilting the torso 77 in the 
longitudinal and lateral directions relative to the 
buttocks 72. The joints provided in the robot 71 as 
described above are operated by actuators, which are not 

25 shown. Although not shown, a control device 50, which is 

similar to that in the aforesaid first embodiment and the 
like, is installed in the buttocks 72 or the torso 77. 
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In the present embodiment, the hierarchical 
structure may be set, as shown in Fig. 70, for the robot 
71 sitting on a chair or the like through the intermediary 
of the buttocks 72. More specifically, a right foot 58, a 
5 left foot 58, the right portion of the base end surface of 

the buttocks 72 (the portion to which a right floor 
reaction force sensor 73 is attached) , and the left 
portion of the base end surface of the buttocks 72 (the 
portion to which a left floor reaction force sensor 73 is 

10 attached) as ground contact portions are associated with a 

first node, a second node, a third node, and a fourth node, 
respectively, which are leaf nodes. Further, a 12th node 
having the first node and the second node as child nodes 
and a 34th node having the third node and a fourth node as 

15 child nodes have been set as intermediate nodes, and a 
1234th node having the 12th node and the 34th node as 
child nodes has been set as a root node. Further, 
according to the policy similar to that in the aforesaid 
first embodiment and the like, the nodes are associated 

20 with desired floor reaction force central points 

Qn (n=l, 2, 3, 4, 12, 34, 1234) , as illustrated. Incidentally, a 
desired floor reaction force central point Q1234 of the 
1234th node, which is the root node, is identical to a 
desired total floor reaction force central point P. 

25 In the present embodiment, the control device 50 is 

supposed to have a functional construction similar to that 
shown in the aforesaid Fig. 2. 
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In this case, a desired ground contact portion 
trajectory of a desired motion in a desired gait output by 
a gait generating device 100 in the present embodiment is 
constructed of the desired position/posture trajectory of 
5 each foot 58 and the desired position/posture trajectory 
of the buttocks 72. The body position/posture trajectory 
of the desired motion means the position/posture 
trajectory of the torso 77. Incidentally, the desired 
motion includes the position/posture trajectory of the 

10 distal portion of each arm 79. Further, the desired total 
floor reaction force central point P is on a virtual plane 
in the air rather than on an actual floor surface. 

In the present embodiment, a hierarchical compliance 
operation determiner 114 has the same functional 

15 components as those of the aforesaid sixth embodiment 

(refer to Fig. 62) . However, in the present embodiment, a 
compensating total floor reaction force moment distributor 
determines and outputs the node compensating floor 
reaction force moments of the intermediate nodes and the 

20 root node in the hierarchical structure shown in Fig. 70 

and the node compensating floor reaction force moments of 
the leaf nodes corresponding to the feet 58. Further, a 
compensating angle determiner determines and outputs the 
node compensating angles of the intermediate nodes and the 

25 root node in the hierarchical structure shown in Fig. 70 
and the node compensating angles of the leaf nodes 
corresponding to the feet 58. In this case, the basic 
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techniques for determining these node compensating floor 
reaction force moments and node compensating angles may be 
the same as the techniques explained in the first to the 
third embodiments or the sixth embodiment. Further, a 
5 floor configuration estimator determines estimated n-th 

floor height errors Zf n_estm (n=l , 2 , 3 , 4 ) by the same 
technique as the technique explained in the aforesaid 
third embodiment, as in the case of the aforesaid sixth 
embodiment, and also estimates ground contact portion 

10 floor inclination errors 8fn(n=l,2) of the feet 58. 

Further, a robot geometric model (inverse kinematics 
calculator) , which is a functional component of the 
control device 50, corrects the positions/postures of the 
ground contact portion of the buttocks 72 and the feet 58 

15 (ground contact portions) to restrain the occurrence of a 

slippage, such as a twist, of the ground contact portions 
and also corrects the position/posture of the body (torso) 
77 basically on the basis of the corrected desired ground 
contact portion positions/postures with deformation 

20 compensation and the desired body position/posture 

mentioned above by the same technique as that in the 
aforesaid sixth embodiment. 

The processing of the control device 50 other than 
that explained above may be the same as that of the 

25 aforesaid sixth embodiment. 

Several modifications related to the embodiments 
explained above will now be explained. 
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An actual node floor reaction force that cannot be 
directly detected by a floor reaction force sensor may be 
estimated by an observer by using another actual ground 
contact portion floor reaction force directly detected by 
5 a floor reaction force sensor, a detected value of an 

acceleration sensor, a detected value of a clinometer, and 
the like, or it may be estimated by a simplified algebraic 
relationship. For instance, the hierarchical compliance 
operation is a rotational compliance operation in which a 

10 ground contact portion is rotated about a desired total 
floor reaction force central point; therefore, even when 
the compliance operation is performed, the vertical 
acceleration of the overall center-of -gravity of the robot 
(or an acceleration component in the direction of a 

15 segment that connects a desired total floor reaction force 
central point and the overall center-of -gravity ) 
substantially agrees with the vertical acceleration of the 
overall center-of -gravity in a desired gait (desired 
motion) of the robot (or an acceleration component in the 

20 direction of a segment that connects a desired total floor 
reaction force central point and the overall center-of- 
gravity) . Hence, the sum of all actual ground contact 
portion floor reaction force vertical components 
substantially agrees with the value obtained by 

25 multiplying the sum of the vertical acceleration of the 
overall center-of -gravity in the desired gait (desired 
motion) of the robot and the gravitational acceleration by 



the total mass of the robot. 

Thus, if an actual n-th node floor reaction force 
cannot be directly detected, then first, the sum 

(hereinafter referred to as the actual non-n-th node floor 
reaction force) of the actual floor reaction forces 

(actual ground contact portion floor reaction forces) of 
all leaf nodes that do not have an n-th node as their 
ancestor node and that are not the n-th node itself is 
determined . 

Next, an estimated n-th node floor reaction force, 
which is an estimated value of an actual n-th node floor 
reaction force, is determined according to the following 
expression 57 . 

Estimated n-th node floor reaction force 
= (Overall center-of -gravity acceleration of desired 
gait + Gravitational acceleration) * Total mass 

- Actual non-n-th node floor reaction force . . . 
Expression 57 

If the body or the like is provided with an 
acceleration sensor, then the center-of -gravity 
acceleration of the entire robot (hereinafter referred to 
as an estimated overall center-of -gravity acceleration) 
may be estimated on the basis of a detected value of the 
acceleration sensor and at least one of a desired gait and 
an actual joint displacement, and an estimated n-th node 
floor reaction force, which is the estimated value of an 



actual n-th node floor reaction force, may be determined 
according to the following expression 58. 

Estimated n-th node floor reaction force 

= (Estimated overall center-of -gravity acceleration + 

Gravitational acceleration) * Total mass 

- Actual non-n-th node floor reaction forces . . . 
Expression 58 

For example, in the aforesaid sixth embodiment, if 
no floor reaction force sensors for detecting knee floor 
reaction forces are provided or floor reaction force 
sensors for detecting knee floor reaction forces fail, 
then an estimated 34th node floor reaction force is 
determined according to the following expression 59. 

Estimated 34th node floor reaction force 

= (Overall center-of -gravity acceleration of desired gait 
+ Center-of -gravity acceleration) * Total mass 

- Actual non-34th node floor reaction forces 

= Overall center-of -gravity acceleration of desired gait * 
Total mass 

- (Actual 12th node floor reaction force + Actual 
56th node floor reaction force) . . . Expression 59 

Further, the estimated 34th node floor reaction 
force is used in place of an actual 34th node floor 
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reaction force to determine the 1234th node compensating 
angle 91234 by the compliance operation processing, and an 
estimated 1234th node relative floor height error 
Z1234rel_estm is also estimated by floor configuration 
5 estimation processing. 

In determining the 34th node compensating angle 034, 
it is assumed that the floor is as expected, and an 
estimated third node floor reaction force, which is the 
estimated value of an actual third node floor reaction 

10 force, and an estimated fourth node floor reaction force, 

which is the estimated value of an actual fourth node 
floor reaction force, are determined on the basis of the 
corrected desired third ground contact portion 
position/posture with deformation compensation, the 

15 corrected desired fourth ground contact portion 

position/posture with deformation compensation, and an 
estimated 34th node floor reaction force. 

Further, the estimated third node floor reaction 
force and the estimated fourth node floor reaction force 

20 are used in place of an actual third node floor reaction 
force and an actual fourth node floor reaction force to 
determine the 34th node compensating angle 634 by the 
compliance operation processing. 

Instead of determining the corrected desired node 

25 floor reaction force moment about a desired node floor 

reaction force central point on the basis of the required 
moment for restoring the posture of the robot 
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(compensating total floor reaction force moment) so as to 
be equivalent to adding the required moment for 
restoration as described above, a corrected desired node 
floor reaction force central point obtained by correcting 
a desired node floor reaction force central point may be 
determined on the basis of the required moment for 
restoration (compensating total floor reaction force 
moment) . In this case, a desired node floor reaction 
force moment about a desired node floor reaction force 
central point is not corrected, so that it remains to be 
zero . 

Further, in order to compensate for a component that 
could not be controlled within an n-th node floor reaction 
force (an expected or detected control error component) , 
the desired floor reaction force of the parent node of the 
n-th node may be corrected. More specifically, the value 
of the difference between an actual n-th node floor 
reaction force and a desired n-th node floor reaction 
force in the last control cycle or the value obtained by 
passing the aforesaid difference through a low-pass filter 
may be added to the desired floor reaction force of the n- 
th node. 

Further, in the aforesaid embodiments, the 
compensating total floor reaction force moments have been 
generated about desired total floor reaction force central 
points; however, this is not essential in the present 
invention. In such a case, for example, the compensating 
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total floor reaction force moment Mdmd may be set to zero 
in carrying out the processing of the embodiments 
described above. 

In the processing of estimating a floor 
configuration, a tree structure that is different from the 
tree structure for the compliance control may be set. The 
tree structure may have two layers composed of a root node 
and leaf nodes. Further, the weight of each node may be 
set to be different from that for the compliance control 
as long as the weight of the node becomes zero in a period 
during which a node floor reaction force is zero (a period 
during which all ground contact portions belonging to the 
node or a ground contact portion corresponding to the node 
moves in the air) . 

Further, in the processing of estimating a floor 
configuration, each corrected node weight may be 
determined on the basis of the aforesaid corrected desired 
node floor reaction force central point, and a vector 
having the determined corrected node weight as an element 
may be used as the weight for estimating the floor 
configuration . 

When determining an estimated relative floor height 
error of each point (each ground contact portion) in the 
processing of estimating a floor configuration, instead of 
using an actual floor reaction force, a mechanism 
compliance model, and the detected value of a posture 
sensor, a deformation amount detector for detecting the 
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deformation amount of a compliance mechanism or the like 
may be provided so as to use a detected value of the 
deformation amount detector and a detected value of a 
posture sensor. 



If a floor configuration is to be not only 
relatively estimated but globally estimated also 
(estimating a floor configuration on a global coordinate 
system), then the following may be carried out. 
1) Estimating the global height of a floor in a case where 
the height of the body of a robot on the global coordinate 
system (hereinafter referred to as the global height) can 
be detected: 

A detector that detects the global height of a 
predetermined portion, such as a body, of a robot (a body 
height estimator using an acceleration sensor (e.g., the 
estimator disclosed in PCT/ JP03/05448 by the present 
applicant) or an external sensor, such as a visual sensor) 
is used. The value of an estimated floor height error on 
the global coordinate system is determined on the basis of 
the estimated body global height, a joint displacement (an 
actual joint displacement or a desired joint displacement) 
the detected value of an actual body posture inclination, 
and the detected value of an actual floor reaction force. 
Thus, the estimated floor height error of the root node 
will have a meaning as the weighted average value of the 
global estimated floor height error of every ground 
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contact portion. 

2) Estimating the global height of a floor in a situation 
wherein the global height of the body is unknown: 
If the global value of a certain estimated n-th floor 
5 height error (the error in the global coordinate system 

rather than the relative value in a group) is known, then 
the global values of the estimated floor height errors of 
all points (ground contact portions) are determined on the 
basis of the above known global value and estimated 

10 relative floor height errors. If the global value of the 

estimated n-th floor height error at the start point of a 
travel of a robot is known, then the global value of the 
floor height error of a ground contact portion that newly 
comes in contact with the ground will be sequentially 

15 determined as the robot continues to travel; therefore, a 
map of floor heights on a travel trajectory of the robot 
can be created by storing the above sequentially 
determined global values. 

Further, in the processing of estimating a floor 

20 configuration, each corrected node weight (obtained by 
correcting the value of the weight of each node) may be 
determined on the basis of the aforesaid corrected desired 
node floor reaction force central point, and the 
determined corrected node weight may be used as the weight 

25 for defining an actual n-th node relative floor height or 
the like in estimating the floor configuration. Further, 
in estimating a floor configuration, the weight used to 
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define the actual n-th node relative floor height or the 
like does not necessarily have to be the same as the 
aforesaid weight determined by the desired floor reaction 
force distributor . 

Supplementally, the weight for defining the actual 
n-th node relative floor height or the like does not 
necessarily have to agree with the weight determined by 
the desired floor reaction force distributor; however, if 
they are to agree with each other (in this case, the 
desired floor reaction force central point of the root 
node will automatically agree with a desired total floor 
reaction force central point) , then the influence of a 
floor configuration error can be canceled simply by adding 
an n-th node estimated floor inclination error to an n-th 
node compensating angle (n=l,2,...) for the compliance 
operation, thus making it possible to reduce the 
calculation volume for canceling the influence of the 
floor configuration error. 

Furthermore, estimated floor configuration errors 
may be stored as the map information on a floor 
configuration, and a desired gait may be generated on the 
basis of the stored map information of the floor 
configuration when a robot walks in the same place next 
time . 

Incidentally, in the first and the second 
embodiments described above, the block diagrams showing 
the arithmetic processing functions may be subjected to 
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equivalent modifications by, for example, changing the 
arithmetic processing sequence. 

Further, the present invention can be applied not 
only to a mobile robot but also to a wheel-type mobile 
5 body having an active suspension. 

Industrial Applicability 

As described above, the present invention is useful 
as the one that makes it possible to provide a mobile body, 
10 such as a legged mobile robot, that permits highly stable, 

smooth operations to be achieved by properly controlling 
floor reaction forces. 



